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FOREWORD 
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Research Branch of the Flight Electronics Division. Dr. David R. 
Downing and Mr. Wayne H. Bryant served as Technical Representatives 
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I. PIFCGT OVERVIEW 


The PIFCGT program is a collection of FORTRAN-coded subroutines 
which can be used to formulate, design, and evaluate a proportional- 
integral-filter (PIF) digital flight control law. The PIF control law 
is designed using the Linear Quadratic Regulator (LOR) formulation to 
obtain feedback gains and command generator tracker (CGT) theory to 
obtain feedforward gains. Structurally, the PIFCGT program is driven 
by a main executive which calls individual modular subroutines. The 
PIFCGT main executive is written using top-down structure and depends 
on user input to determine which of the program subroutines are to be 
used for a given control law design. 

Flexibility in the PIFCGT program is accomplished by using a 
general multivariable control design approach and employing dynamic 
(vector) data storage. In almost all cases, data arrays in PIFCGT 
subroutines are treated as packed one-dimensional arrays which can’ 
easily be passed between subroutines without a maximum array size 
parameter appearing as an argument of the calling sequence. The 
dynamic storage capability allows subroutine program size to be 
specified and controlled through the PIFCGT main executive. The use 
of common blocks has been reduced to a minimum (PIFCGT, AEROD, CRWM, 

DPIFS, FGAERO, RUNINFO) in order to increase subroutine modularity 
and portability. 

The PIFCGT program is explicitly written for a specific application: 
the design of any one of nine PIF autopilots for the NAVION general 
aviation aircraft. The PIFCGT program has been developed as part of 



the effort in NASA Langley Research Center's General Aviation Terminal 
Area Operation Research (GATOR) program. The GATOR program is directed 
at developing and evaluating advanced flight control, guidance and 
display concepts that make use of the recent advances in digital flight 
control hardware, digital control theory, navigation and landing systems, 
and electronic displays. 

This report constitutes the second part of a two part report. 

The first part in Ref. 1 is a discussion of the derivation, design, 
implementation, and flight testing of the PIF control law autopilots. 
This report documents the software that is used by a PIF control law 
designer to produce PIF control gains, evaluate PIF closed-loop 
performance, and determine PIF linear simulations to command inputs. 

A. PROGRAM IMPLEMENTATION 

The PIFCGT program was developed using the facilities of the NASA 
Langley Research Center Computer Complex. The program was written for 
execution on a CDC 6600 using the FORTRAN FTN4 compiler. 

PIFCGT requires 140,000 o octal locations for execution using a 

O 

segmentation procedure. PIFCGT requres 224,300g octal locations for 
execution without segmentation. The maximum number of model states 
allowed is 20 (12 aircraft states + 4 control states + 4 integrator 
states in a fully coupled PIF aircraft control design). The maximum 
number of control and command states allowed is 4. 

A command file consisting of the JOB control information is re- 
quired to execute each of the autopilot designs under the NASA Langley 
NOS 1.3 operating system. A command file example for the NOS 1.3 oper- 
ating system is presented in Appendix B along with the segmentation 
directives in Appendix C. 
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All of the data needed by PIFCGT from a user designing one of the 
nine autopilot is read from a NAMELIST file. The NAMELIST files used 
in the NAVION PIF designs for each autopilot are presented in Appendix A. 

The PIFCGT program can be easily extended to design one of the 
nine autopilots for a variety of aircrafts other than the NAVION by 
simply changing the aerodynamic data base in the BLOCK DATA (AEROD) 
subroutine. Changes to the aerodynamic data base can also be performed 
using the NAMELIST variables. A new autopilot command system (auto- 
throttle for example) not currently available in PIFCGT can be incorpor- 
ated into the program by adding (i.e., not modifying) software in three 
subroutines (HDCON, DPIFS, and PIFG) in the form of alternative "GO TO 
XX" code sections. This built-in "expandability" feature is a special 
feature of PIFCGT that makes new autopilot designs straightforward. 

B. DOCUMENTATION 

The next two chapters in the report are directed to input and 
output requirements of the programs and subroutines. Chapter 2 is de- 
voted to the mam program PIFCGT. A step by step discussion is given 
for the flow of the program and all variables used in the program are 
defined in a Table. Chapter 3 describes each of the primary level 
subroutines used by PIFCGT. The secondary level subroutines are 
composed of subroutines from the ORACLS library system (ORACLIB) , 

Ref. 2, and specialized subroutines written by Information & Control 
Systems. Documentation for ORACLIB can be found in Ref. 2 and is not 
presented in this report. 
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II. PIFCGT DESCRIPTION 


PIFCGT uses a top-down structure that depends on user input to 
determine which program chapters are to be used for a given design. 

There are five main chapters: data initialization and set up, PIF 

matrix construction, feedforward matrix construction, PIF design and 
performance analysis, and PIF time history computation. Two flags 
control the main logic, ICH(I,J) and ICHOSE. ICH(I,J) indicates 
which chapters are to be executed; I represents the ith chapter and J 
represents the jth section within the ith chapter. ICHOSE is an 
integer which indicates which autopilot mode is to be designed by 
the program. The nine autopilot ICHOSE options are shown in Table 1. 

Two of the APF LOC autopilots may eventually be discontinued depending 
on flight test results. 

During the course of developing PIFCGT, print statements have been 
used to check intermediate calculations. All the print statements remain 
in PIFCGT, but are inactivated by setting logical variables beginning 
with the 4 letters "DEBU" to FALSE. Table 1 lists the areas of software 
for which each "DEBUG" variable activates print statements. 

Two features may be added to the PIFCGT program by a user to en- 
hance its capabilities. The ORACLS subroutines, EIGEN (used by FREEO, 
Section S) sometimes has numerical difficulties computing eigenvalues with 
sufficient accuracy. An alternative eigenvalue /eigenvector procedure not 
available in ORACLS (but available in FTNMLIB - a NASA Langley computer 
center math library) is discussed in FREEF, Section R. The second feature 
is a plotting capability. A ploting package was developed for PIFCGT but 
is highly machine dependent and is not documented in this report. 
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A. PIFCGT CHAPTERS 


This section presents a list of the chapters that can be activated 
by the logical variable ICH. The format for the presentation of the 
PIFCGT chapters consists of the logical array variable element, the name 
of the program or subroutine that the logical element activates and a 
brief description of the function performed. The user should follow the 
logic in the PIFCGT main executive program while reading this section. 
ICH (1,1) (PIFCGT) INITIALIZE CONSTANTS 

PIFCGT begins by calling the ORACLS subroutine RDTITL. RDTITL 
defines data statements in internal ORACLS common blocks and reads a 
user defined title card which is shown at the end of the submit file 
in Appendix B. 

ICH(1 , 2) (PIFCGT) READ IN FLAGS AND DESIGN PARAMETERS 

The NAMELISTS NAM1, NAM2, NAM3, NAM5 , NAM6 , AER01, AERO 2, and 
NAM7 are read in from logical unit 20. If "DEBUXX" variables are TRUE, 
the NAMELISTS are printed using the namelist output format. 

ICH (1,3) (RUNINFO) PRINT OUT FLAGS AND DESIGN PARAMETERS 

The subroutine RUNINFO is called for the first time. RUNINFO is 
the information subroutine that echos the flag conditions and chapter 
calls the user has specified in the namelists. 

ICH(1,4) (INTERP) INTERPOLATES AERODYNAMIC DATA AT VTP 

The aerodynamic coefficients in the common blocks AERO and AER1 
are assumed to be for two different straight and level trim conditions 
(a lower and a higher forward velocity, respectively). INTERP uses the 
variable VTP as an intermediate velocity to interpolate the coefficients 
for a trim condition at VTP. The interpolated values overwrite the 
values in AERO. 
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ICH(1,4) (FGAERO) CONSTRUCT F AND G (BODY AXIS) MODEL MATRICES 
The nonlinear equations of motion of the aircraft have been 
explicitly linearized about a straight and level flight condition. 

The linearization equations and the aerodynamic data in AERO are used 
in FGAERO to construct the (12 x 12) plant system matrix, F, and the 
(12 x 4) control effect matrix, G. 

ICH(1,5) (FGAERO) TRANSFORM F AND G SO ANGLES AND CONTROLS ARE IN DEG 
FGAERO constructs F and G with units of feet for distance and 
radians for angles. If ICH(1,5) is TRUE (as is the case in all NAME- 
LISTS in Appendix A), F and G are converted to use angular units of 
degrees. Units of feet and radians produce numerically ill-conditioned 
matrices in later computations. 

ICS (1,10) (DIMSS) SET UP DIMENSION PARAMETERS 

ORACLS requires that each matrix vector have a two-dimensional integer 
vector that specifies the first dimension of the matrix in the first 
location of the integer vector and the second dimension of the matrix 
in the second location. DIMSS initializes the two-dimensional integer 
vectors . 

ICH(1, 11) (PIFCGT) PRINT OUT THE F AND G MATRICES 
ICH(1,15) (FREEO) FIND EIGENVALUES AND EIGENVECTORS OF OPEN-LOOP F 
MATRIX 

ICH(1, 16) (HAD AC) CONSTRUCT HA AND DA ACCELERATION OBSERVATION MATRICES 
Later in the construction of the PIF control law (PIFG) some of 
the state feedback elements (Au, Av, Aw) can be replaced with accelerometer 
output feedback (Aa^, Aa^, Aa^) by transforming the feedback gains. 

The matrices HA and DA mathematically relate the linearized accelerometer 
output with the body-axis aircraft states and controls using 
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( 1 ) 


Aji = HA * Ax + DA * Aii 

and are required to perforin the feedback gain transformation. 

ICH(2,2) (HDCON) DEPENDING ON ICHOSE CONSTRUCT H, D, FM, GM, HM, AND 
DM MATRICES 

The command output matrices (H and D) and command model matrices 
(FM, GM, HM, and DM) are constructed in HDCON depending on the value 
of ICHOSE. Logical vectors, XR, UR, YR, XMR, and UMR are initialized 
for later use in REMAT. 

ICH(1, 3) (RUNINFO) PRINT OUT FLAGS AND DESIGN PARAMETERS 

RUNINFO is called for the second time and echos values of para- 
meters constructed in subroutines and specified in NAMELISTS. 

ICH(2 , 4) (CFWM) CONSTRUCT COST FUNCTION WEIGHTING MATRICES; A, R, AM, 

RD, QZ 

Linear Quadratic Cost function weighting elements in the common 
block QWHT are used to form the cost function weighting matrices Q, R, 

AM, RD, and QZ. 

ICH(2,5) (PIFMODL) CONSTRUCT PIF MODEL MATRICES PHI, GAMA, QHAT, RHAT 

The continuout-time mathematical model matrices for the PIF Linear 
Quadratic Regulator problem are formed. 

ICH(2 ,6) (REMAT) REDUCE MATRICES BY ELIMINATION 

Using the logical vectors XR, UR, YR, XMR, and UMR, undersired 
states, controls and commands are eliminated from the PIF matrices. The 
result is that the fully coupled PIF design matrices are reduced in dimen- 
sion. The reduction performed in REMAT usually leaves only longitudinal 
related states or lateral-directional related states. 

ICH(2 , 7) (PIFEIG) FORM DESIRED CLOSED-LOOP MODEL FROM PLANT MODEL 

The Riccati matrix equation solution procedure in DREG requires a 
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starting stabilizing PIF gain to find a solution. The ORACLS subroutine, 
DSTAB, often is not able to numerically find a stabilizing gain matrix. 
PIFEIG, in combination with PIFPLC, finds a stabilizing gain matrix using 
an eigenvalue/eigenvector placement procedure. PIFEIG constructs a PIF 
model that has stable eigenvalues. The procedure works even if the PIF 
model is stabilizable but not controllable. 

ICH (2,8) (PIFMODL) REPLACE U FEEDBACK WITH AX FEEDBACK IN HX DX 
ICH(2 ,9) (PIFMODL) REPLACE V FEEDBACK WITH AY FEEDBACK IN HX DX 
ICH (2, 10) (PIFMODL) REPLACE W FEEDBACK WITH AZ FEEDBACK IN HX DX 
ICH(2 ,12) (PIFMODL) REPLACE AX FEEDBACK WITH VT FEEDBACK IN HX DX 
ICH(2,13) (PIFMODL) REPLACE AY FEEDBACK WITH BETA FEEDBACK IN HX DX 
ICH (2, 14) (PIFMODL) REPLACE AZ FEEDBACK WITH ALPHA FEEDBACK IN HX DX 
The feedback gain in PIFG is transformed to allow for different 
sensors. AX, AY, and AZ are the body mounted accelerometer sensor obser- 
vations. VT, BETA, and ALPHA are the pitot tube, sideslip vane and angle 
of attack vane sensor observations. If ICH(2,12) is TRUE, then ICH(2,8) 
must be TRUE, etc. HX and DX are the sensor observation matrices. Obser- 
vation matrices for VT, BETA, and ALPHA are formed in HADAC. 

ICH (2, 11) (PIFEIG) USE RANDOM NUMBERS TO HELP FIND PHICL 

The stable model formed in PIFEIG and stored in PHICL uses the 
feedback gain GK during construction. The elements in GK are generated 
internally in PIFEIG if ICH (2, 11) is TRUE or must be passed to PIFEIG by 
the designed from NAM5 if ICH(2,11) is FALSE. 

ICH (3,1) (DISCMOD) FORM DISCRETE EQUIVALENT OF CONTINUOUS MODEL AND PLANT 
If ICH(3,1) is FALSE the feedforward matrix construction scalar, 

SSS, is set to 0.0 and DF, DG, DFM, and DGM are set to equal F, G, FM, 
and GM, respectively. If ICH(3,1) is TRUE the feedforward matrix scalar, 
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SSS is set to 1.0 and the discrete plant and model representations are 
obtained for a zero-order hold in the control. 

One of the objectives of the lateral-directional command model is 
to cause the sideslip to be zero when the aircraft is banked in a turn. 

When designing the ICH0SE= 9 (APR LOCI) autopilot, the second element in 
DGM must be adjusted so that the feedforward matrix element S12(l) is 
zero. S12(l) * <p^ is the steady state side velocity. The second element 
in DGM is adjusted by the program automatically, a maximum of IKDGM times 
using the feedback equation 

DGM(2) = DGM(2) + DKDGM * DELT * S12(l) (2) 

IKDGM and DKDGM are specified by the designer so that the iterative adjust- 
ment procedure shown in Eq. 2 is stable. 

If ICHOSE=15 or 16 (APR LOCR or APR LOOP autopilots) the digital 
model matrix element DGM(3) is set to zero. Note : If ICH0SE=16 is the 

desired autopilot design, the subroutine HDCON makes the appropriate 
adjustments, then resets ICHOSE to ICH0SE=15. The ICHS0E=16 (APR LOCP) 
design is performed this way because it is very similar to the ICH0SE=15 
command model (APR LOCR) . 

ICH(3, 2) (CGTPIF) SOLVE FOR FEEDFORWARD MATRICES 

A description of this subroutine, which is an involved procedure 
for finding the feedforward matrices Sll, S21, S22, and S23, is given in 
Chapter 3, Section E. 

ICH(4 ,2) (QRMP1) FORM DISCRETE EQUIVALENT OF CONTINUOUS SYSTEM USING 
ORACLS SUBROUTINES 

ICH(4, 3) (QRMHAT) FORM DISCRETE EQUIVALENT OF CONTINUOUS SYSTEM USING 


ALPHA AND BETA SUBROUTINES 
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These two subroutines transform a continuous-time Linear Quadratic 
Regulator PIF control problem into a sampled-data regulator PIF control 
problem. ORACLS fails to perform the transformation if there is only 
one control; QRMHAT must be used under this condition. When both sub- 
routines execute properly, their answers are identical. 

ICH (4,4) (PIFPLC) PLACE THE EIGENVALUES AND EIGENVECTORS USING PIF CONTROL 
PIFPLC uses the discrete PIF plant representation and the discrete 
plant representation of PHICL (constructed in QRMHAT (or QRMP1)) to 
determine a stabilizing feedback gain using eigenvalue/eigenvector 
placement. 

ICH(4 ,5) (PIFPLC) FIND LOG OF F + GK IN PIFPLC BEFORE FINDING EIGENVALUES 
After PIFPLC determines the stabilizing feedback gain, the resulting 
closed-loop eigenvalues are printed out if DEBU44 is TRUE. If ICH(4,5) 
is TRUE, the discrete-time closed-loop plant is transformed to the equi- 
valent continuous- time plant using the log of a matrix before determining 
the eigenvalues. 

ICH(4 ,6) (DREG) SOLVE DISCRETE RICCATI EQUATION FOR FEEDBACK GAINS 
The discrete-time algebraic Riccati equation is solved using 
Newton's method. If ICH(2,7) is TRUE, the initial feedback gain GK is 
assumed to be stabilizing. If ICH (2, 7) is FALSE, the subroutine DREG 
attempts to find an initial stabilizing gain, using the ORACLS subrou- 
tine DSTAB. DSTAB is not always successful. 

ICH(4 , 7) (L0GX1) FIND EQUIVALENT CONTINUOUS SYSTEM FOR A CLOSED-LOOP 
PIF CONTROLLER 

The log of a matrix is used to transform PHICL=PHI-GAMA*GK to an 
equivalent continuous plant. The closed-loop eigenvalues are stable 
in the left-half complex plane. 
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ICH(4,8) (PIFFRE) FIND CLOSED-LOOP EIGENVALUES AND EIGENVECTORS 

The ORACLS subroutine EIGEN is used to find the eigenvalues and 
eigenvectors of PHICL. EIGEN is sometimes inaccurate. 

ICH(4 ,9) (PIFG) COMPUTE THE PIF GAINS 

The optimal regulator gains and feedforward gains are combined 
in PIFG to produce the final implementable PIF controller. If METERS 
is TRUE, PIFG transforms the implementable gains to use units of meters 
for distance and radians for angular units. 

ICH(5 , 3) (DPIFS) SIMULATE PIF CONTROLLER FOR COMMAND INPUTS 
ICH(5,4) (DPIFS) PRINT OUT PLANT STATES AND CONTROLS OF SIMULATION 
ICH(5 ,5) (DPIFS) PRINT OUT STAR TRAJECTORY OF THE SIMULATION' 

Using information specified by the designer in UMAG, USTRT and 
USTP (discussed in HDCON) , DPIFS simulates the PIF controller in the form 
used for implementation. A nonlinear representation of the command model 
is used to generate the command model trajectories. A linear model of 
the aircraft is used to propagate the plant dynamics. The plant states 
and controls are printed out if ICH(5,4) is TRUE. The star trajectory 
computed using the feedforward matrices Is printed out if ICH(5,5) is 
TRUE. 

B. DEFINITION OF VARIABLES 

All variables used in the PIFCGT main program are defined in Table 
1. The common block for each variable is also identified in Table 1. 
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TABLE 1. PIFCGT Variable Definitions 


MATRICES 

ACL 

AM 

AMHAT 
0 AC 

OX 

ER, EI> IE 
E RV , IEV 


3 AM A 
GK 

HAC 

HX 

PHI 

PHICl 

3HAT 

RHAT 
X 9 
X 

MATRIX SYSTEMS 
Frt,GMHM,DM 
OFM , DGM * HM, DM 
F , G » H , 0 

DF,DG»W> D 
S11,S12, $21,S22 
S31»S32»SA1>S‘*2 


WORK MATRIX 

STATE, CONTROL CROSS WEIGHTING CAUSED BY 30VE IN 
CONTINUOUS PLANT 

{(N+M+L) X M ) PIF DISCRETE CROSS WEIGHTING MATRIX 
(3 X M) ACCELEROMETER OUTPUT CONTROL OBSERVATION 
MATRIX 

(N X M) SENSOR OUTPUT CONTROL OBSERVATION MATRIX 
USE Y«HX*X + DX+U FOR FEEDBACK 

IF ICH(2,16) IS FALSE THEN PIFF.IG ASSIGNS CLOSED 
LOOP EIGENVALUES TO THOSE DICTATED BY ER AND El 
ER IS THE REAL PART, El IS THE IMAGINARY PART 
I E ( I ) = 1 REPLACE THE ITH EIGENVALUE OF F WITH 
THOSE OF ER(I),EI(I). THIS FfcAIURC IS NOT USED. 

I E ( I ) = 0 DO NOT REPLACE THE EIGENVALUE OF F 
IF I CH ( 2 , 16 ) IS FALSE THEN PIFEIG ASSIGNS CLOSED 
LOOP EIGENVALUES T3 THOSE DICTATED BY ERV. 
EIGENVECTORS ARE STORED AS REAL NUMBERS IN ERV 
IN ROWS. IF AN EIGENVECTOR IS COMPLEX THE FIRST 
ROW FOR THE EIGENVECTOR IS THE REAL PART AND THE 
SECOND ROW IS THE POSITIVE IMAGINARY PART. 

IEV(I) * 1 REPLACE THE ITH EIGENVECTOR OF F WITH 
THOSE OF ERV(I). THIS FEATURE IS NOT USED. 

IEVtl) « 0 OQ NOT REPLACE THE EIGENVECTOR OF F 
((N+M+L) X M ) PIF PLANT CONTROL MATRIX 
(M X (N+M+L)) PIF GAIN FROM RICCATI EQUATION 
SOLUTION 

(3 X N) STATE OBSERVATION PERTURBATION MATRICES 
FOR AX > AY , AZ 

IN X N) ACCELEROMETER OUTPUT STATE OBSERVATION 
MATRIX 

((N+M+L) X (N + M + D) PIF PLANT SYSTEM MATRIX 
( ( N + M+L ) X (N + M + D) CLOSED-LOUP PIE PLANT IN DREG 
ANO IDEAL MODEL MATRIX IN P IFL IG , PI F PLC 
((N+M + L) X (N+M + D) PIF DISCRETE STATE QUORATIC 
WEIGHT MATRIX 

(M X M) PIP DISCRF TE CONTROL QUADRATIC 
WORK MATRIX 

((N+M+L) X (N+M+L)) PIF DISCRETE RICCATI 
LQUAT ION SULUT ION 


QUAD SYSTEM MATRICES 
(CONTINUOUS MOOED 
QUAD SYSTEM MATRICES 
(DISCRETE MODEL) 

QUAD SYSTEM MATRICES 


FOR COMMAND MODEL 
FOR COMMANO MODEL 
FOR AIRCRAFT MODEL 


(CONTINUOUS MODEL) 

QUAD SYSTEM MATRICES FOR AIRCRAFT MODEL 
(DISCRETE MOOED 

CGT FEEDFORWARD MATRIX SOLUTION 
(SEE CGTPIF) 

PIF REFORMATEO GAINS 
(SEE PIFG AND DPIFS) 
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TABLE 1. (CONTINUED) PIFCGT Variable Definitions 


AFROQYNAMIC DATA 






C LBOQT 

CL AOQT 

CMBQOT 

CMAOOT 

CNBDOT 

CNADQT 

cxo 

CXP 

CXO 

CXR 

CXB 

C X A 

. cxdt 

CXDE 

CXOA 

CXDR 




:yo 

CYP 

CYQ 

C YR 

CYB 

CYA I 

CYDT 

CYOE 

CYOA 

CYOR 




czo 

CZP 

CZO 

CZR 

C ZB 

CZA I 

: zot 

CZOE 

CZOA 

CZOR 




:lo 

CLP 

CLO 

CLR 

CLB 

CLA i 

:lot 

CLOE 

CLOA 

CLDR 




CMO 

CMP 

CMO 

CMR 

CMB 

CMA ! 

cmot 

C MO E 

CMOA 

CMDR 




cno 

CNP 

CNO 

CNR 

CNB 

CN A 

:not 

CNOE 

CNO A 

CNOR 




other variables 






VARIABLF : 

OMMON BLOCK 

DESCRIPTION 




A 

AEPO 

WING AREA 

ISO FT) 




AK1 

RNINFQI 

FEEDBACK GAIN OF MOOEL 




AK2 

RNINFOI 

FEEDBACK GAIN OF MODEL 




3 

AERO 

WING SPAN 

(FT) 




C 

AERO 

C8AR MEAN 

AERODYNAMIC CHORO(FT) 



*+ALL INPUT OUAORATIC WEIGHTS ARE SOUARED IN 

CFWM WHEN THEY 

ARE PLACED 

IN 0, R 

# RD> QZ, OR QDVE. 





DA 

QWHT 

R WEIGHT ON AILERON POSITION 



OARO 

3 WHT 

RO WEIGHT 

ON AILERON RATE 



DAO 

AERO 

AILERON TRIM VALUE 




0E9UHA 

DEBG 

T - PRINTS 

OUT NAMELIST 

AERQ1 



DEBUM1 

OEBG 

T - PRINTS 

OUT NAMELIST 

NAMI 



0FBUM2 

0 EBG 

T - PRINTS 

OUT NAMELIST 

NAM2 



0EBUM3 

DEBG 

T - PRINTS 

OUT NAMFLIST 

NAM3 



0 E 8 J M A 

OEBG 

T - PRINTS 

OUT NAMELIST 

NAMA 



0EBUH6 

OEBG 

T - PRINTS 

UUT NAMELIST 

NAM6 



DEBIJIA 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

FGAERO 

06BU22 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

HQCQN 

DE8 J24 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

CFWM 

3E8U25 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

PIFMODL 

0EBU26 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

REMAT 

3EBU27 

DEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

PIFEIG 

0EBU31 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

0I3CM0D 

0E8UA2 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

QRMP1 

DEBUA3 

DEBG 

T - PRINTS 

OUT INTERMEDIA! t VALUES 

IN 

QRMHAT 

DE8UA4 

DEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

PIFPLC 

3 E8UA6 

DEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

DREG 

OEBU'tB 

OFBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

PIFFRE 

0EBUA9 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

PIFG 

0EBU53 

OEBG 

T - PRINTS 

OUT INTERMEDIATE VALUES 

IN 

DPIFS 

0 EL T 

EIGEN 

CONTROL CAW SAMPLING INTERVAL 



OER 

Q WHT 

R WEIGHT ON ELEVATOR POSITION 



DERO 

3 WIIT 

RO WEIGHT 

ON ELEVATOR RATE 



3 FO 

AERO 

ELEVATOR TRIM VALUE 




OREAL 

RNINFO 

STABILITY 

TEST PARAMETER 

IN ASYMREG 

• 

SHOULD BE 



LESS THAN 

ZERO. 
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TABLE 1. (CONTINUED) PIFCGT Variable Definitions 


ORR 

QWHT 

R WEIGHT ON RUDDER POSITION 

3RR0 

QwHT 

RO WEIGHT UN RUDOLR RATE 

ORO 

AERO 

RUDDER TRIM VALUF 

3 TH 

QWHT 

R WEIGHT ON THROTTLE POSITION 

3 THD 

QWIIT 

RO WEIGHT ON THROTTLE RATE 

DTO 

AERO 

THROTTLE TRIM VALUE 

ECGT 

RNINFO 

CONVERGENCE TEST IN SOLVER IN CGT FOR INVERTING 

ELOG 

RN1NF0 

MATRIX 

RECUMMAND 1.0E-10 FOR CDC MACHINE 
CONVERGENCE TEST FOR L0GX1. SHOULD BE 1.0E-10 

EPS 

EIGEN 

1.0F-08 NOT USED 

GKOGM 

RNINF01 

FEEDBACK GAIN USED TO ADJUST GM SO THAT STEADY 

GKDICP 

RNINF02 

STATE SIDESLIP IS ZFRO IE ICHUSE « 9 
INTERCEPT GAIN FOR COMPUTING DO FEEDBACK GAIN 

GKDMAX 

RNINF02 

MAXI NUN DO FEEDBACK GAIN VALUE 

GKDMIN 

RN1NF02 

MINIMUM DO FEEDBACK GAIN VALUE 

GKDSLP 

RNINF02 

SLOPE GAIN FOP COMPUTING DO FEEDBACK GAIN 

GKPSI 

RNINFQ1 

PSI ERROR GAIN IN ICHDSE»6,I5 AND 16 DESIGN 

SKY 

RNINFQ1 

YERROR GAIN IN ICHtlSE = 15 AND 16 DESIGN 

GR 

AERO 

GRAVITY (FT/SEC**2> 

ICGT 

ICGT ( 1 ) 

RNINFO 
*1 Oil, 

012, 021, 022 CONSTRUCTED 


FM,GM,HM,DM,SU,S12,S21,S2 2,FW,GW.A,B,C,G, S31,S32, 
SA1,SA2 MUST APPEAR IN CALLING SEQUENCE BUT ARE NOT 
USED IN PROGRAM EXECUTION 
ICGT( 1 ) *2 S11,S21 CONSTRUCTED 

S2I>S22>FW,GW»A,G,C>F,S31,S32>SAl>SA 2 MUST APPEAR IN 
CALLING SCQUENCE BUT ARE NOT USED IN PROGRAM EXECUTION 
I C G T ( 1 > »3 SH,S21,S21» S22 CONSTRUCTED 

FW,GW. A, Q,C»E, S31,S32, SA1, SA2 MUST APPEAR IN CALLING 
SEQUENCE BUT ARE NOT USED IN PROGRAM EXECUTION 
ICGTUJ-A SJ1,S32,S‘,1,S42 CONSTRUCTED 

FM,GM,HM,0M, S 11 , S 12 , S2 L > S2 2 MUST APPEAR IN CALLING 


ICGTt 11*5 
ICGTC A )»1 
I C GT ( A ) »2 
I CGTI 5 ) * 1 


SEOUENCE BUT ARE NOT USED 
CONSTRUCT ALL FEEDFORWARD 
PRINT OUT UU, 012,021,022 
PRINT OUT 011,012,021,022, 
00 NOT PERFORM QUAD INVERS 
PASSED IN CALLING SEQUENCE 


IN PROGRAM EXECUTION 

MATRICES 

MATRICES 

S11,S12,S21,S22 MATRICES 
E 011,012,021,022 ARE 
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TABLE 1. (CONTINUED) PIFCGT Variable Definitions 


ICH EIGEN LOGICAL ARRAY CONTAINING INFORMATION ON WHICH 

SUBROUTINES TO CALL FROM PIFCGT 

ICHQSE RN1NFO 

IC HOSE » 1 BETA AND ROLL CONSTANT COMMAND SYSTEM FOR LATERAL 

DYNAMICS. BETA AND ROLL ANGLE ARE COMMANDED 
IN UM AG ( 1 i 1 ) ANO UMAG<2.1)i RESPECTIVELY. 

ICHOSE = 3 ROLL AND PSI TURNING COMMAND SYSTEM FOR LATERAL SYSTEM. 

PSI IS COMMANDED IN UMAGtlil). 

ICHOSE = A PITCH COMMAND SYSTEM FOR LONGITUDINAL OYNaMICS. 

PITCH ANGLE IS COMMANDED IN UMAGtlil). 

ICHOSE = 6 PSI OUTER LOOP COMMAND SYSTCM USING ROLL ANO 

RUDDER INNER LOOP - GKPSI IS THE OUTER LOOP YAW G A*N , 
YAW AND RUDDER COMMANDED IN UMAGtlil) ANO UHAG<2>1*. 

ICHQSE * 7 Zi ZDO T COMMAND SYSTEM FOR LONGITUDINAL SYSTEM WITH 

Z COMMANDED IN UMAG (1*1). 

ICHOSE = 9 LOCALIZER TRACKING MQDFL COMMANDING Y AND ROLL. 

Y INITIAL CONDITION IS SET IN UMAG(1»1). 

PSI INTERCEPT ANGLE IS SET IN UMAG(2>1). 

USTRT MUST START AT ZERO USTP MUST BE AT MAXMIUM. 

ICHQSE * 12 ROLL AND RUDDER COMMAND SYSTEM FOR LATERAL SYSTEM. 

ROLL AND RUDDER COMMANDED IN UMAGIlil) AND 
UMAG( 2i I ) • 

ICHOSE = 14 0 COMMAND SYSTEM FOR GLIOESLOPE TRACKING. 

UMAGtlil) CONTAINS 0 POSITION OFFSET AT 
START AT OUTER MARKER • USTRT SHOULO BE O.O. 

USTOP SHOULD BE MAXIMUM TIMF. A MODEL IN 
SIMULATION MOVES 0 TO ZERO KEEPING FLIGHT 
PATH ANGLE WITHIN BOUNDS. Z IN F AND G 
IS RE PL AC EO WITH D OYNAMICS. 

LAMDA IS FLIGHT PATH ANGLE IN DEGREES. 

ZETA IS GROUND PFLAIVE HEADING ANGLE IN DEGREES. 
ICHOSE = 15 Y OUTER LOOP COMMAND SYSTEM USING ROLL ANO 

RUDDER INNFR LOOP - GKPSI IS THE OUTER LOOP 
YAW GAIN AND GKY IS THE OUTER LOOP Y GAIN. 

Y INITIAL CONDITION IS SET IN UMAGtlil). 

PSI INTERCEPT ANGLE IS SET IN UMAG(2il). 

USTRT MUST START AT ZERO USTP MUST 8E AT MAXMIUM. 


ICHOSE » 16 Y OUTER LOOP COMMAND SYSTEM USING ROLL AND RUDDER 

INNER LOOP - GKY IS THE OUTER LOOP Y GAIN. 

Y INITIAL CONDITION IS SET IN UMAGtlil). 

PSI INTERCEPT ANGLE IS SET IN UMAGUil). 

USTRT MUST START AT ZERO USTP MUST BE AT MAXMIUM. 

I DREG RNINFO OPTIONS FOR ASYMREG AS DISCUSSED IN ORACLES 

IFREEF EIGFN Oi 1 OR 2 E IGEN V AL UE / E IGEN VEC TORS FOR F MATRIX 

IFREFG EIGEN Oi 1 OR 2 NOT USED 

I FREE P EIGEN Oi 1 OR 2 fc IGEN VAL UES / E IGEN VEC TORS FOR PIF CLOSED- 

LOOP 

IFR6IG EIGEN Oi 1 OR 2 E I GENV AL UE S / E IGENVEC TOR S FOR PIFEIG 

IDEAL MODEL MATRIX DCSIGN 

0 - NO CALCULATIONS IN FRE6Q 

1 - EIGENVALUES ONLY 

2 - C I^LNVALULS AND EIGENVECTORS 

IKOGM RN INF OI NUMBER OF ITER AT IONS ALLOWED TO ADJUST DGM SO 

SlEADY STATE SIDESLIP IS 0.0 IF ICHQSE *9il5 OR 16 
IMAX LABEL NUMBER OF TIME STEPS IN OPIFS SIMULATION 

IRUN LABEL NUMBER OF SIMULATIONS IN OPIFS ISHOULO BE 1.0) 

ITFR RNINFO MAXIMUM NUMBER OF ITERATIVE RES IOUALT IONS IN 

SULVER 




TABLE 1. (CONTINUED) PIFCGT Variable Definitions 


IX 

AERO 

MOMENT OF INERTIA (SLUG/FT*+2> 

IY 

AERO 

MOMENT OF INERTIA (SLUG/FT**2) 

1 Z 

AERO 

MOMENT OF INERTIA (SLUG/FT**2> 

L 

GLAD 

NUMBER OF STARTING COMMAND VARIABLES 

LAMOA 

RN INFO 

FLIGHT PATH ANGLE OF TRIMMED FLIGHT 
CONDITION FOR AERODYNAMIC DATA (USUALLY 0.0 
STRAIGHT ANO LEVEL FLIGHT) 

L AM DAGS 

R NINFO 

GLIDESLOPE ANGLE (ALWAYS. POSITIVE USUALLY 3.0 DEG) 

l AMDA1 

RN INFO 

FLIGHT PATH ANGLE OF TRIMMED FLIGHT 
CONDITION FUR AERODYNAMIC DATA (USUALLY 0.0 
STRAIGHT ANO LFVEL FLIGHT) 

M 

GLAD 

NUMBER OF STARTING CONTROLS VARIABLES 

METERS 

RN INFO 

LOGICAL VARIABLE THAT DETERMINES IF THE SIMULATION 

DATA IS IN METERS OR NOT 

METERS * TRUE (DATA IN METERS/SEC) 

METERS = FALSE (DATA IN FEET/SEC) 

NEW CONTROL GAINS ARE PRINTED OUT IN PIFG IF 
METERS IS TRUE. THE NEW CONTROL GAINS ASSUME 
RADIANS FOR ANGLES AND CONTROL VARIABLES AND 
METERS FOR DISTANCE VARIABLES. 

MLOG 

RNINFO 

MAXIMUM NUMBER OF ITERATIONS IN LOG OF A MATRIX 
(L0GX1) SUBROUTINE 

MM 

GLAO 

DIMFNSIGN OF MODEL CONTROLS 

M 

GLAO 

STARTING NUMBER OF STATE VARIABLES 

MM 

GLAO 

DIMENSION OF MODEL 

P90Q 

QWHT 

QDVE WEIGHTING OF POOT 

P BO 

QWHT 

Q WEIGHTING OF P 

PHOQ 

QWHT 

QUVE WEIGHTING OF PHIDOT 

PHIO 

AERO 

TRIM VALUE OF PHI 

PHO 

QWHT 

Q WEIGHTING OF PHI 

PSOO 

QWHT 

QUVE WEIGHTING OF PSIDOT 

PSIO 

AERO 

TRIM VALUE OF PSI 

PSQ 

QWHT 

0 WEIGHTING OF PSI 

PO 

AERO 

TRIM VALUE OF P 

3B00 

QWHT 

Q WEIGHTING OF QOOT 

OBO 

QWHT 

Q WEIGHTING OF Q 

00 

AERO 

TRIM VALUE OF Q 

R80Q 

QWHT 

QDVE WEIGHTING OF RDOT 

RBO 

QWHT 

Q WEIGHTING OF R 

R HO 

AERO 

AIR DENSITY ( S L UGS / FT* *3 ) 

RO 

AERO 

TRIM VALUE OF R 

S 

AERO 

CALCULATED IN FGAERO 

SS 

EIGEN 

SS » 1.0 IF ICGT(l) .GT. 2 AND PLANT > MODEL/ AND 



DISTURBANCE ARE DISCRETE TIME MODELS 



SS = 0.0 IF ICGT(l) . GT • 2 AND PLANT > MODEL, AND 



DISTURBANCE ARF CONTINUOUS TIME MODELS 



SS * ANY NUMBER IF ICGT(I) . L£ • 2 EXCEPT PLANT 



TRANSMISSION ZEROES 

THOO 

QWHT 

Q WEIGHTING OF THE T ADQT 

THE T AO 

AERO 

TRIM VALUE OF THETA 

THO 

QWHT 

Q WEIGHTING OF THETA 

TOL 

RNINFO 

CONVERGENCE CRITERIA FOR ITERATIVE RESIDUALTION IN 
SOLVER. RECOMMEND i.OE-10 FOR CDC MACHINE 

UBOQ 

QWHT 

QDVE WEIGHTING OF UOOT 

JBO 

QWHT 

Q WEIGHTING OF U 

UL 

LABEL 

ARRAY CONTAINING THE LABLES FOR THE CONTROLS 

JMAG 

UOIR 

ARRAY OF MAGNITUDE OF COMMAND INPUTS IN DPIFS 
SIMULATION (MM X IRUN) NOT REDUCED IN REMAT 

UMR 

EIGEN 

LOGICAL ARRAY WITH INFORMATION TO REFORMAT THE 
COMMAND MODEL CONTROL MATRIX GM (L X MM) 

UR 

EIGEN 

LOGICAL ARRAY CONTAINING THE INFORMATION TO 
REFORMAT THE AIRCRAFT CONTROL MATRIX-G (NXM ) 

JSTP 

UOIR 

ARRAY OF TIMES AT WHICH COMMAND INPUTS ARE 
RETURNEO TO ZERO IN DPIFS SIMULATION (MM X IRUN) 
NUT REDUCED IN REMAT 
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TABLE 1. (CONCLUDED) PIFCGT Variable Definitions 


USTRT 

UDIR 

ARRAY OF TIMES AT WHICH COKMANO INPUTS ARE 
CHANGED FROM ZERO TO UMAG VALUES IN OPIFS 
SIMULATION (MM X IRUN) NOT REDUCED IN REMAT 

UXM4G 

LABEL 

ARRAY CONTAINING THE SCALING VALUES FOR CONTROLS 
(NOT USED) 

JO 

AERO 

TRIM VALUE OF U 

VSOQ 

QWHT 

00 VE WEIGHTING OF VDOT 

vho 

QWHT 

Q WEIGHTING OF V 

VTO 

AERO 

TRIM VALUE OF VT 

V TP 

RH1NF0 

TOTAL AIRSPEED VELOCITY IN FT/SEC++Z. USED IN 
INTERP. TRIM VALUES AND AERODYNAMIC DATA ARE 

INTERPOLATED SO THAT AIRCRAFT MOOEL IS FOUND FOR 
VTO * VTP. 

VO 

AERO 

TRIM VALUE OF V 

WBOQ 

QWHT 

QOVL WEIGHTING OF 'WDOT 

WBQ 

awnr 

Q WEIGHTING OF W 

WT 

AL.tU 

W L 1 Oil I (LBS) 

VO 

AtKO 

TRIM VALUE OF U 

X IOQ 

QWHT 

ULIGHTING ON XOOT POSITION 

X I Q 

QWHT 

WEIGHTING ON X POSITION 

XL 

LABEL 

ARPAY CONTAINING THE LABELS FOR THE STATES 

X MR 

EIGEN 

LOGICAL ARRAY WITH INFORMATION TO REFORMAT JHE 
COMMAND MOOEL SYSTFM MATRIX FM (NM X NM) 

XR 

EIGEN 

LOGICAL ARRAY WITH INFORMATION TO REFORMAT THE 
AIRCRAFT SYSTEM MATRIX F (N X N) 

XS 

HO X A 

LOCATION OF ACCELEROMETERS IN BODY AXIS, 
X-POS I T ION WITH REFERENCE TO CG 

XXMAG 

LABEL 

ARRAY CONTAINING THE SCALING VALUES FOR STATES 
USEU IN OPIFS WHEN METERS IS TRUE, AUTOMATICALLY 
SCALED 

YIOQ 

QWHT 

WEIGHT ING ON YDOT POSITION 

r 10 

QWHT 

WEIGHTING ON Y POSITITON 

T L 

LABEL 

ARRAY CONTAINING THE LABELS FOR THE COMMANDS 

YR 

EIGEN 

LUGICAL ARRAY WITH INFORMATION TO REFORMAT THE 
OUTPUT MATRICES H, D, HM , DM (L X N),(L X M) , ( L X NM) 
( L X MM) 

YS 

HO X A 

LOCATION OF AC C ELL R UM E TER S IN BODYAXIS, 
Y-POSITIOU WITH REFERENCE TO CG 

YXMAG 

L ABF L 

ARRAY CONTAINING THE SCALING VALUES FOR OUTPUTS 
(NOT USED) 

ZCOMAX 

RNINFCU 

MULTIPLICATION FACTOR FOR CHANGING ZOO MAXIMUM 

ZCLMAX 

RNINFU1 

MULTIPLICATION FACTORS FOR CHANGING ZCLOSE 

ZCLMIN 

RNINF01 

MULTIPLICATION FACTORS FOR CHANGING ZCLOSE 

zclose 

RNINFOI 

POSITION DIFFERENCE WHEN FULL DECELERATION BEGINS 

ZOOMAX 

RNINFU1 

MAXIMUM ACCELEARTION 

ZOOMAX 

RNINFU1 

MAXIUM MODEL RATE 

7 FT A 

RNINFQ 

VELOCITY VECTOR HEADING ANGLE OF TRIMMEO FLIGHT 
CONDITION (USUALLY 0.0) 

ZETA1 

RN INFO 

VELOCITY VECTOR HEADING ANGLE OF TRIMMED FLIGHT 
CONDITION (USUALLY 0.0) 

Z I 00 

QWHT 

WEIGHTING ON ZDOT POSITION 

Z 10 

QWHT 

WEIGHTING ON Z POSITION 

zs 

HO X A 

LOCATION OF ACCELEROMETERS IN BODYAXIS, 
Z-PQS I T ION WITH REFERENCE TO CG 

ZIQ 

QWHT 

QZ WEIGHTING OF FIRST INTEGRATOR STATE 
(QZ REFORMATED USING YR) 

Z 20 

QWHT 

QZ WEIGHTING OF SECOND INTEGRATOR STATE 
(QZ REFURMATED USING YR) 

Z3Q 

QWHT 

QZ WEIGHTING OF THIRD INTEGRATOR STATE 
(QZ REFORMATLO USING YR) 

ZAO 

QWHT 

QZ WEIGHTING OF FOURTH INTEGRATOR STATE 
(QZ RfcEORMA ICO USING YR) 
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III. SUBROUTINE DOCUMENTATION 


All subroutines used by PIFCGT are from ORACLS (ORACLIB in 
Appendix B) or from the PIF library (PIFLIBO in Appendix B) . This 
chapter individually documents in alphabetical order the PIF library 
subroutines. The documentation follows the same format at ORACLS 
in Ref . 2 . 
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A. BLOCK DATA (AEROD) 


1. PURPOSE 

Block data program AEROD initializes aerodynamic data in common blocks 
AERO and AER1. Other variables are initialized from common blocks 
listed in 2d below. 

2. USAGE 

Under the NOS 1.3 operating system, AEROD is placed in the submit file 
as shown in Appendix B. 

a. Calling Sequence 
None 

b. Input Arguments 
None 

c. Output Arguments 
None 

d. Common Blocks 

RNINFO, LABEL, EIGEN, GLAD, IDENTS, DEBUG, AERO, AER1 , HDXA 

e. Error Messages 
None 

f. Subroutines Employed by AEROD 
None 

g. Subroutines Employing AEROD 
None 

h. Concluding Remarks 
None 
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B. SAMPLED-DATA REGULATOR (ALPHA AND BETA) 


1. PURPOSE 

The purpose of the subroutines ALPHA and BETA is to compute the following 
functions depending on the values of LLL and H, 

If LLL = 2, and H = 0.0 then compute 

SUM = / At / T e A S ds Q / T e As ds dr ( 1 ) 

o o v/ 

If LLL = 1, and H = -1.0 then compute 

SUM = / At e A T Q / T e As ds dT (2) 

Subroutine ALPHA calls subroutine BETA as part of its execution. 

2. USAGE 

a. Calling Sequence 

CALL ALPHA (N, A, AT, ASIG, SIG, 0, GEST, EPSLO, LLL, H, SUM, Al, SSI, 

SS, A2, BVEC , AVEC, XMLIH) 

b. Input Arguments 

N Integer scalar value indicating matrix dimension; A, AT, ASIG, 

Q, SUM, Al, SSI, SS, A2 , BVEC, AVEC, XMLIH - all N x N. 

A Matrix packed by column in one-dimensional array; not destroyed 

upon return. 

AT Matrix packed by column in one-dimensional array; not destroyed 

upon return. AT must contain the transpose of A. 

ASIG, Al, 

SSI, SS, 

A2, BVEC, 

AVEC, 

XMLIH Working space vectors of dimension at least N x N 
SIG Real scalar indicating the sampling time At. 

GEST An index for starting the test of convergence in computing the 
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integrals. A value of 5.0 is recommended. 

EPSLO Real scalar indicating the convergence criterion in computing 
the integrals. A value of 0.00001 is recommended. 

LLL, H An integer scalar and a real scalar, respectively, used to 
determine the integrals discussed in the PURPOSE section. 

c. Output Arguments 

SUM An N x N matrix packed by columns into a one-dimensional array 

containing the evaluation of the computed integrals. 

d. Common Blocks 

None 

e. Error Messages 

None 

f. Subroutines Employed by ALPHA and BETA 

ORACLS - MULT, UNITY 

g. Subroutines Employing ALPHA and BETA 

PIFLIB - QRMHAT 

h. Concluding Remarks 

None 
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C. SOLUTION OF A*Y*B-X=C (AXBMXC) 


1. PURPOSE 

Subroutine AXBMXC solves the algebraic matrix equation 

A*X*B - X = C (1) 


First the matrix A is transformed to the lower real SCHUR form using 

the unitary transformation U. Next, the matrix B is transformed to 

upper real SCHUR form using the unitary transformation V. The matrix 

T 

C is transformed using U * C * V. Equation 1 reduces to 

tri rp fp rp 

(U AU)*(U XV)*(V BV)-(U XV) = U CV (2) 

or 

A*X*B-X=C (3) 

s s s s s 


The subroutine SHRSOL is used to solve Eq. 3 for X g . The solution X, 

is reconstructed for X as follows 

s 

X = U*X *V T (4) 

s 

It is assumed that 


^ ^ 1 (i=l,2, . . . ,N; j=l,2, . . . ,M) 

A B 

where A^ and A^ are eigenvalues of A and B respectively, 
is true, Eq. 1 has a unique solution for X. 


(5) 


If Eq. 5 


2. USAGE 

a. Calling Sequence 

CALL AXBMXC (A,U,B,V,C,N,NA,NU,M,NB,NV,NC,EPSA,EPSB,FAIL) 

b . Input Arguments 

A, B, C Matrices stored in two-dimensional array. First dimensions 
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are NA, NB, and NC, respectively. Second dimensions are at 
least N, M, and N, respectively. Destroyed upon return. 

N Order of the matrix A 

M Order of the matrix B 

NA,NB,NC, 

NU,NV Maximum first dimensions of the matrices A, B, C, U, and V, 
respectively, as given in the dimension statement of the 
calling program. It is required that NA .GT.N+1, NB .GT. M+l, 

NC .GT. N+l, NU .GT. N+l, and NV .GT. M+l 

EPSA Criterion for zeroing elements in the matrix A in the subroutine 
SCHUR. A(I,J) is considered effectively 0 if it is less than 
EPSA times the infinity norm of the upper Hessenberg form of A 
NOTE: If EPSA .LT. 0 it is assumed that A is already in 

lower real SCHUR form and U is the appropriate trans- 
formation matrix. 

EPSB Criterion for zeroing elements in the matrix B in the subroutine 
SCHUR. B(I,J) is considered effectively 0 if it is less than 
EPSA times the infinity norm of the upper Hessenberg form of B. 
NOTE: If EPSB .LT. 0 it is assumed that B is already in 

upper real SCHUR form and V is the appropriate trans- 
formation matrix. 

c. Output Arguments 

FAIL Integer flag indicating success of reduction of A and B to 

lower and upper real SCHUR form. If FAIL is not zero, SCHUR 
was unsuccessful. 

U Two-dimensional array containing the orthogonal matrix which 

reduces A to lower real SCHUR form. First dimension is NU. 
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Second dimension is at least N. 


V Two-dimensional array containing the orthogonal matrix which 

reduces B to upper real SCHUR form. First dimension is NV. 
Second dimension is at least M. 

A,B Two-dimensional arrays containing the original A and B matrices 

transformed to lower and upper real SCHUR form, respectively. 

C Two-dimensional array containing the solution, X. 

d. COMMON Blocks 
None 

e. Error Messages 
None 

f. Subroutines Employed by AXBMXC 
ORACLS - BCKMLT, HSHLDR , SCHUR, SYSSLV 
PIFLIB - SHRSOL 

g. Subroutines Employing AXBMXC 
PIFLIB - SOLVER 

h. Concluding Remarks 

It is recommended that the program SOLVER, which calls AXBMXC, be 
used to solve Eq. 1. This subroutine is a generalization of the 
algorithm reported in Ref. 3. 
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D. CREATE WEIGHTING MATRICES (CFWM) 


1 . PURPOSE 

The subroutine CFWM constructs the diagonal weighting matrices used 
in the PIF control law quadratic cost function. The state weights 
UBQ, WBQ, QBQ, THQ, XIQ, ZIQ, VHQ, RBQ, PBQ, PHQ, PSQ, YIQ are squared 
and placed along the Q matrix diagonal. The control weights DTH, DER, 
DA, and DRR are squared and placed along the R matrix diagonal. The 
control rate weights DTHD, DERD, DARD, DRRD are squared and placed 
along the RD matrix diagonal. The integrator weights ZIQ, Z2Q, Z3Q 
and Z4Q are squared and placed along the QZ matrix diagonal. The 
state rate weights UBDQ, WBDQ, QBDQ, THDQ, XIDQ, ZIDQ, VBDQ, RBDQ, 
PBDQ, PHDQ, PSDQ and YIDQ are squared and placed along the W9(LW1) 
diagonal. The following matrix is constructed 

" Q1 [ AM 1 
_ AM | R1 

The Q1 matrix is added to Q and the Rl matrix is added to R completing 
the weighting matrix constructions. F and G are the continuous-time 
plant system matrix and control effect matrix, respectively. 

2. USAGE 

a. Calling Sequence 

CALL CFWM(F, NF, G, NG, Q, NQ, R, NR, AM, NAM, RD, NRD , QZ, NQZ, W9, 
NW9DIM, DEBUG) 

b. Input Arguments 

F, G Matrices packed by columns into one-dimensional arrays; 

not destroyed upon return. 


W9 (LW1) [F G ] 


( 1 ) 



NF, NG, NQ, 

NR, NAM, NRD, 

NQZ Two dimensional integer vector holding the number of rows 

and columns of the matrix shown after the letter N. Integer 
values must be: NF(12, 12), NG(12, 4), NQ(12, 12), 

NR (4, 4), NAM(4, 12,), NRD (4 , 4), NQZ(12, 12). 

W9 Work matrix packed by columns into a one -dimensional array. 

Dimension must be at least 4 * ((NF(1) + NG(2))**2 +1). 
DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

NW9DIM Integer scalar containing the maximum dimension of the 
W9 matrix. 

c. Output Arguments 
Q, R, AM, 

RD, QZ Weighting matrices packed by columns into one dimensional 
arrays. 

d. COMMON Blocks 
QWHT 

e. Error Messages 

If the W9 matrix is insufficiently large the message "THE W9 MATRIX 
IS SMALL" is printed and the program stops. If DEBUG is true then 
Q, R, RD, QZ, and W9(LWl) (QDVE) are printed after being diagonally 
constructed. After the state rate construction and assimilation Q, R, 
RD, QZ, and W9(LW1) (QDVE) are printed again along with AM. 


26 



f. Subroutines Employed by CFWM 

ORACLS - JUXTC, ADD, PRNTITL, DIAGPUT, PRNT, MATBA, EXTR 

g. Subroutines Employing QRMHAT 
PIFLIB - PIFCGT 

h. Concluding Remarks 


None 



E. FEEDFORWARD MATRICES (CGTPIF) 


1. PURPOSE 


Subroutine CGTPIF computes the feedforward matrices S^, 

£> 22 ’ S^, ^ 32 ’ ^41’ anc ^ ^42' ^e su ^ rout ^ ne determines the feed- 
forward matrices by solving the following matrix equation 



S , (F — ssl) S 1 1 G S (F -ssl)— AS_ G -B 
11 m 11 m 31 w 31 w 

HD -C -E 

m m 


( 1 ) 


The feedforward matrix equation is valid for both continuous-time 
models and discrete-time models. The scalar ss in Eq. 1 is chosen 
by the designer under the following restrictions, ss cannot equal a 
transmission zero of the plant. If the dynamical models are repre- 
sentations of continuous-time systems and s 22 » ^ 32 ’ or S 42 as to 

be determined, then ss must be zero. If the dynamical models are 
representations of discrete-time systems and S-^j s 2 2 ’ S 32 or S 42 as 
to be determined then ss must be one. 

The plant, disturbance, and model matrices in the feedforward matrix 
equations are assumed to satisfy the following dynamical equations 

CONTINUOUS TIME 

PLANT 

x = Fx + Gii + Aw + Bs_ (2) 

X = Hx + Du + C w + E s_ (3) 

DISTURBANCE TO BE REJECTED 

w = F w + G s (4) 

— w— w— 
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MODEL TO BE 

FOLLOWED 


X 

= F x + G u 

(5) 

— m 

nr-m nrm 

*m 

= H x + D u 
m-m rn-rn 

(6) 


DISCRETE TIME 


PLANT 



3c+l 

= Fx^ + Gu^ + Aw^ + Bs^ 

(7) 


= Hx^ + Du^ + Cw^ + Es^ 

(8) 

DISTURBANCE 

TO BE REJECTED 


w 

^+1 

= F w. + G s. 
w-k 

(9) 

MODEL TO BE 

FOLLOWED 


x , , , 

= F x + G u 

(10) 

“m,k+l 

m-m,k nr-m,k 

^-m,k 

= H x , 4- D u , 
nr-m,k m— m,k 

(11) 

The program 

begins by forming the quad partition matrix on the 


left side of Eq. 

1. If the number of outputs in equal the number 



of controls in u, the program attempts to invert the quad partition 
matrix using GELIM. If the quad partition matrix is not square or 
GELIM encountered an error in attempting to invert the quad parti- 
tion matrix, CGTPIF attempts to find the pseudo-inverse of the quad 
partition matrix using singular value decomposition (SNVDEC) . If 
SNVDEC also encounters an error, a message is printed and the program 
continues . 
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After obtaining the inverse (or pseudo-inverse) 


(F-ssI) 

G 

-1 

°11 

Q 12 

H 

D 


fi 21 

^22 


Eq. 1 is separated into eight algebraic matrix equations, 


S 

S 

S 

S 

S 

S 

S 

S 



= 

n 

s 

11 


n 

11 


_ 

Q 

s 

12 


11 

11 




n, 

s 

21 


21 

11 





s 

22 


21 

11 




£2 

s 

31 


11 

31 




n 

s 

32 


n 

31 




£2 

s 

41 


21 

31 




£2 

s 

42 


21 

31 


(F -ssl) + ft H 
m 12 m 

m 12 m 

(F -ssl) + £2 H 
m 22 m 

G + £2 D 
m 22 m 

(F -ssl) + ft.. , A - 

W 11 

G - £2.. 1 B - n.-E 

w 11 12 

(F -ssl) + £2.. A - 

W Zl 


G - £2 01 B - n„E 
m 21 22 



C 



C 


( 12 ) 


(13) 

(14) 

(15) 

(16) 

(17) 

(18) 

(19) 

( 20 ) 


Equations 13 and 17 are solved using SOLVER. Equations 14, 15, 16, 18, 
19, and 20 are solved using matrix multiplication. 

2. USAGE 

a. Calling Sequence 

CALL CGTPIF (F ,G ,H,D, A, B, C , E,FW,GW,FM,GM,HM, DM, W1 ,W2 ,W3 ,W4 ,W5 ,011,012 , 
021,022,S11,S12,S21,S22,S31,S32,S41,S42,N,M,L,NM,MM,NW,MW,T0L,ITER,SS, 
ICGT,ECGT,NS11,NS12 ,NS21,NS22 ,NS31,NS32,NS41,NS42) 

b. Input Arguments 
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F.G.H 
A, B,C 
FW,GW 
GM,HM 


N,M,L 

NM,MM 

NW,MW 


TOL 


ITER 


ECGT 


ICGT 


D, 

E, 

FM, 

DM Matrices packed by columns in one-dimensional arrays; not 
destroyed upon return. 

Integer scalar values indicating matrix dimensions: 

F-NxN, G-NxM, H-LxN, D-LxM, A-NxNW, B-NxMW, C-LxNW, E-LxMW, 
FW-NWxNW, GW-NWxMW, FM-NMxNM, GM-NMxMM, HM-LxNM , DM-LxMM 
Real scalar indicating convergence criteria for iterative 
refinement in SOLVER. Recommend 1.0E-10 for CDC machine. 
Integer scalar indicating maximum number of iterative 
refinements in SOLVER. Recommend 10. 

Real scalar indicating convergence criteria in SOLVER for 
inverting a matrix. Recommend 1.0E-10 for CDC machine. 

Five dimensional integer option vector: 


ICGT(l) = 1 

Oil, 012, 021, 022 constructed. 
FM,GM,HM,DM, Sll, S12 , S22 ,FW,GW,A, B, C, E, 



S31,S32,S41,S42 must appear in calling sequence 
but are not used in program execution. 

ICGT (1) = 2 

Sll, S21 constructed. 



S21,S22,FW,GW,A,B,C,E,S31,S32,S41,S42 

must 


appear in calling sequence but are not 
program execution. 

used in 
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ICGT(l) = 3 Sll, S12, S21, S22 constructed. 


FW,GW,A,B,C,E,S31,S32,S41,S42 must appear in 
calling sequence but are not used in program 
execution. 

ICGT(l) = 4 S31, S32, S41, S42 constructed. 

FM,GM,HM,DM,S11,S12,S21,S22 must appear in 
calling sequence but are not used in program 
execution. 

ICGT(l) = 5 Construct all feedforward matrices. 

ICGT(4) = 1 Print out Oil, 012, 021, 022 matrices. 

ICGT(4) = 2 Print out all matrices. 

ICGT(5) = 1 Do not perform quad inverse. Oil, 012, 021, 
022, are passed in calling sequence. 

SS Scalar option 

SS = 1.0 if ICGT(l) .GT. 2 and plant, model and disturbance 
are discrete time models 

SS = 0.0 if ICGT(l) .GT. 2 and plant, model and disturbance 
are continuous time models 

SS = Any number if ICGT(l) .LE. 2 except plant transmission 
zeroes. 

W1,W2,W3 

W4,W5 Working space vectors of dimension at least: 

W1 - (2*(N+MAX(L,M)+2))**2, W2,W3,W4,W5 - (N+MAX(L,M)+2)**2 
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c. Output Arguments 


011 , 012 , 

021,022 Matrices packed by columns into one-dimensional arrays. 

Upon normal return and depending on ICGT, the matrices 
contain the partitioned quad inverse 


Xi 

to 

1 


Oil 

012 

_ n 21 

U 22_ 


021 

022 


Dimensions of the matrices are at least: 

Oil - N**2 , 012 - N*L, 021 - M*N, 022 - M*L. 

Sll, S12 , 

S21.S22, 

S31.S32, 

S41,S42 Matrices packed by columns into one-dimensional arrays. 

Upon normal return and depending on ICGT, the matrices con- 
tain the feedforward matrices. Dimensions of the matrices 
are at least (N+MAX(NM,NW)+2)**2. 

NS11,NS12 , 

NS21.NS22 , 

NS31.NS32, 

NS41.NS42 Two-dimensional integer vector holding the number of rows 

and columns of the matrix shown after the letter N. Example, 
NS11(1) = N 
NS11(2) = NM 

d. COMMON Blocks 

None 

e. Error Messages 
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If ICGT(l) .GT. 2 and SS .NE. 1 the message "???????????? SS IS INCORRECT 

IN CGT ???????????? BUT PROGRAM CONTINUES SS = is printed. 

If the plant is a continuous-time model and SS = 0.0, then the error 
should be ignored. CGTPIF cannot determine if the dynamic models are 
continuous or discrete and operates under the implicit assumption that 
the models are discrete. 

If GELIM or SNVDEC encounter an error the message "SNVDEC ERROR IN CGT 
I ERR = " is printed. 

f. Subroutines Employed by CGTPIF 

ORACLS - MULT, NULL, SCALE, SUBT, UNITY, ADD, NORMS, BCKMLT , HSHLDR , 
SCHUR, SYSSLV, GELIM, DETFAC 
PIFLIB - AXBMXC , SHRSOL, PRNT, PRNTITL. 

g. Subroutines Employing CGTPIF 
PIFLIB - PIFCGT, PIFPLC 

h. Concluding Remarks 

The theory and use of feedforward matrices are discussed in Refs. A 
and 5. 
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F. CLOSED-LOOP d MODEL (CLDMOD) 

1. PURPOSE 

Subroutine CLDMOD propagates the dynamic command model for the APR 
GS autopilot mode. The subroutine is similiar to the APR GS command 
model in the flight computer code. A discussion of the equations used 
in CLDMOD is given in Ref. 1. 

I 

2. USAGE 

a. Calling Sequence 

CALL CLDMOD (Dl, DO, LAMDMAX, LAMIN, DEBUG, LAMDAGS, VTP, 

LAMC, GKDSLP, GKDICP, GKDMAX, GKDMIN) 

b. Input Arguments 

Dl, DO k and k-1 commanded d perpendicular position of aircraft 
from glideslope. Changed upon return. 

LAMDMAX The maximum allowed flight path angle change in DELT seconds 
(ZDDMAX in input NAMELIST) 

DELT The control law sampling interval 

LAMAX The maximum allowed flight path angle. (ZCLMAX in input 

NAMELIST) 

LAMIN The minimum allowed flight path angle. (ZCLMIN in input 

NAMELIST) 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

LAMDAGS The glideslope angle (positive) 

VTP The total airspeed in ft/sec 
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LAMC 


The commanded model dynamics flight path angle at k-1. 
Changed upon return. 

GKDSLP The slope gain for computing the DO feedback gain. 

GKDICP The intercept gain for computing the DO feedback gain. 

GKDMAX The maximum DO feedback gain value. 

GKDMIN The minimum DO feedback gain value. 

c. Output Arguments 

Dl, DO k+1 and k commanded d perpendicular position of aircraft 
from glideslope. 

LAMC The commanded model dynamics flight path angle at k. 

d. COMMON Blocks 
None 

e. Error Messages 

The first pass through the subroutine causes GKl , LAMAX, LAMIN and 
LAMDAGS to be printed out. If DEBUG is TRUE, Dl , D.0, LAMDAGS, GKl, 
and LAMC are printed out during the course of the simulation. 

f. Subroutines Employed by CLDMOD 
None 

g. Subroutines Employing CLDMOD 

PIFLIB - DPIFS 

h. Concluding Remarks 

None 
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G. CLOSED-LOOP Y MODEL (CLYMOD) 


1 . PURPOSE 

Subroutine CLYMOD propagates the dynamic command model for the APR 
LOCI, APR LOCR, and APR LOCP autopilot modes. The subroutine is simi- 
liar to the' APR LOC command model propagation model in the flight 
computer code. A discussion of the equations used in CLYMOD is given 
in Ref . 1 . 

2. USAGE 

a. Calling Sequence 

CALL CLYMOD (Y1 , YO, PS11, PS10, YC, PSIC, AK2 , ROLLCM, GKDSLP, 

GKDICP , GKDMAX, GKDMIN , DELT, DEBUG RDCMAX, VTP, ROLLC) 

b. Input Arguments 

Yl, YO k and k-1 commanded Y position of aircraft from localizer r 
beam center line. Changed upon return. 

PS11, PS10 k and k-1 commanded yaw position of the aircraft relative 
to the runway. Changed upon return. 

YC The commanded value of y which is set to 0.0. 

PSIC The maximum allowed intercept angle, usually 45 deg. 

AK2 The yaw error feedback gain for the roll angle command. 

ROLLCM The maximum allowed value of the roll angle command during 
capture (ZDDMAX in input NAMELIST) 

GKDSLP The slope gain for computing the YO feedback gain. 

GKDICP The intercept gain for computing the YO feedback gain. 

GKDMAX The maximum YO feedback gain value. 
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GKDMIN 


The minimum YO feedback gain value. 

DELT The control law sampling interval. 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

RDCMAX The maximum allowed roll angle change in DELT sec (ZCDMAX 

in input NAMELIST) 

VTP The total airspeed in ft/sec 

ROLLC The commanded value of roll angle at k-1. Changed upon 

return. 

c. Output Arguments 

Yl, YO k+1 and k commanded y position of aircraft from beam 
center line. 

PSI1, PSIO k+I and k commanded yaw position of aircraft. 

ROLLC The commanded value of roll angle at k. 

d. COMMON Blocks 
None 

e. Error Messages 

% 

The first pass through the subroutine causes PSIC, AK2 , ROLLCM and 
RDCMAX to be printed out. If DEBUG is TRUE, PSICM, YO, GK2 , PSIO, 
ROLLC, Xl , GKl and PSID are printed out during the course of the 
simulation. 

f. Subroutines Employed by CLYMOD 
None 

g. Subroutines Employing CLYMOD 
PIFLIB - DPIFS 

h. Concluding Remarks 
None 
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H. CLOSED-LOOP ^ AND Z MODEL (CLXMOD) 


1. PURPOSE 

Subroutine CLXMOD propagates the dynamic command model for the HDG 
SEL and ALT SEL autopilot modes. The subroutine is similiar to the 
HDG SEL and ALT SEL command model propagation models in the flight 
computer code. A discussion of the equations used in CLXMOD is given 
in Ref. 1. 

2. USAGE 


a. Calling Sequence 


CALL CLXMOD (Zl, ZO, ZD1, ZDO, ZC1, ZCD, AK1 , AK2 , ZDDMAX, ACLOSE 

ZDOMAX, DELT, ZCLMAX, ZCLMIN, ZCDEAD, DEBUG, ZCDMAX, ICHOSE, VTPO 
b. Input Arguments 


Zl, ZO 
ZD1 , ZD4> 
ZC1 

ZCD 

AK1 , AK2 
ZDDMAX 
DELT 
DEBUG 


ICHOSE 


k and k-1 commanded z (V) position of aircraft 
k and k-1 commanded z (<j>) of aircraft. . 

Commanded value of Z('F) position the model is required 
to track. 

Commanded value of z (cj> ) , usually 0.0. 

Position and velocity feedback gains for the model 
The maximum allowed model acceleration (z or <}>) 

The sampling interval of the control law 
Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

Integer scalar indicating the desired autopilot design 


(See HDCON) 



VTP The total airspeed in ft/sec. 

c. Output Arguments 

Zl, ZO k+i and k commanded z (ip) position of aircraft 

ZD1, ZDO k+1 and k commanded z (cf>) of aircraft 

d. COMMON Blocks 
None 

e. Error Messages 

The first pass through the subroutine causes AK1 , AK2 , ZDDMAX, and 
ZCLOSE to be printed out. If DEBUG is TRUE then ZC1 , ZO, ZDG, ZDO 
ZDD, XI, GKl, and ZDOMAG are printed out. 

f. Subroutines Employed by CLXMOD 
None 

g. Subroutines Employing CLXMOD 
PIFLIB - DPIFS 

h. Concluding Remarks 
None 
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I. COMBINE MATRICES (CORNER) 


1. PURPOSE 

Subroutine CORNER inserts one matrix into another such that they have a 
common corner. 

2. USAGE 

a. Calling Sequence 

CALL CORNER ( A , NA , B , NB , IWHERE ) 

b . Input Arguments 

A Matrix packed by columns; destroyed upon return. 

B. Matrix packed by columns; not destroyed upon return. 

NA,NB Two-dimensional vectors giving number of rows and columns of 
respective matrices, for example: 

NA(1) = number of rows of A 
NA(2) = number of columns of A 
Not destroyed upon return. 

IWHERE Option for combination of the two matrices: 1 use lower left corner 

as common, 2 use upper right corner as common. 

c. Output Arguments 

A Matrix packed by columns containing A & B combined. 

d. COMMON Blocks 
None 

e. Error Messages 

If either NA(1) < NB(1) or NA(2) < NB(2), or NA(1) x NA(2) < 1, or 

NB(1) x NB (2) < 1, the message "DIMENSION ERROR IN CORNER NA = , 

NB = " is printed and the program is returned to the calling point. 
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f. Subroutines Employed by CORNER 
None 

g. Subroutines Employing CORNER 

PIFLIB - PIFMODL, QRMP1 , QRMHAT, PIFG, FGAERO , PIFEIG 

h. Concluding Remarks 

Matrix B replaces a portion of A. Therefore A must be as big or bigger 
than B. This is essentially an overlaying process. If IWHERE is 1, B 
is positioned such that the lower left corner element of A is replaced 
with the lower left corner of B and so forth. IWHERE of 2 indicates 
that the upper right corner of A and B are made equal. If B is smaller 
than A, one corner of B will occur part way into A. See Diagram below. 

IWHERE = 1 
IWHERE = 2 
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J. DIAGONAL PARTITION (DIAGPAR4 


1. PURPOSE 

To combine two matrices such that they become the top left and bottom right 

matrices of a quad partition matrix. The top right and bottom left matrices 

are set to zero in the quad partition matrix. 

2. USAGE 

a. Calling Sequence 

CALL DIAGPAR (A,NA,B,NB,C,NC) 

b . Input Arguments 

A,B Matrices packed by columns in one-dimensional arrays; not destroyed 

upon return. 

NA,NB Two-dimensional vectors giving the number of rows and columns of 
respective matrices; for example: 

NA(1) = Number of rows of A 
NA(2) = Number of columns of A 
Not destroyed upon return. 

c. Output Arguments 

C Matrix packed by columns in a one-dimensional array. Upon return A 

becomes the upper left hand matrix and B becomes the lower left hand 
matrix within the quad partition matrix C. If NB(1) = 0, then C = A. 

NC Two dimensional vector: Upon return, 

NC (1) = NA(1) + NB(1) 

NC(2) = NA(2) + NB(2) 

unless NB(1) = 0, then 
NC(l) = NA(1) 

NC(2) = NA(2) 
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d. COMMON Blocks 


None 


e. Error Messages 


None 


f. Subroutines employed by DIAGPAR 
ORACLS - NULL and EQUATE. 

g. Subroutines employing DIAGPAR 
PIFLIB - PIFMODL, PIFG, FGAERO , PIFEIG. 

h. Concluding Remarks 


C = 


A i 

- -i 
0 i 


0 


B 
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K. FORM A DIAGONAL MATRIX (DIAGPUT) 


1. PURPOSE 

Places elements of a vector along the diagonal of a square matrix. 

2. USAGE 

a. Calling Sequence 
CALL DIAGPUT (A,NA,B,NB) 

b. Input Arguments 

A Vector of elements to be placed on diagonal of output matrix. 

NA Number of elements in A. 

c. Output Arguments 

B Matrix with diagonal elements from A packed by columns in one 

dimensional array, off diagonal elements are zero. 

NB Two-dimensional vector containing number of rows and columns in B. 

NB(1) = NA 
NB(2) = NA 

d. COMMON blocks 
None 

e. Error Messages 
None 

f. Subroutines employed by DIAGPUT: 

ORACLS - NULL 

g. Subroutines employing DIAGPUT: 

PIFLIB - CFWM, FGAERO , PIFEIG. 
b. Concluding Remarks 

Example A 

B 


= £a, b, c, d, e J 


a 
0 

0 0 
0 0 
0 0 


0 0 0 0 
b 0 0 0 


c 

0 

0 


0 0 
d 0 
0 e J 
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L. DIMENSIONS (DIMSS) 


1. PURPOSE 

The subroutine DIMSS loads the integer dimensions into the two 
dimensional vectors. 

2. USAGE 

a. Calling Sequence 

CALL DIMSS (N, M, L, NM, MM, NF, NQ, NAM, NR, NG, NH, ND, NFM, NGM, 
NHM, NDM, NPH, NGA, NQH, NRH, NAMH, NGK, NX, NPHC, NGKQ, NGKI, NQZ) 

b. Input Arguments 
N, M, L, 

NM, MM Integer scalars indicating matrix dimensions. N is the 

number of plant states, M is the number of plant controls, 
L is the number of plant commands, NM is the number of 
model states and MM is the number of model controls. 

c. Output Arguments 
NF, NQ, NAM, NR, 

NH, NG, ND, NFM, 

NGM, NHM, NDM, 

NPH, NGA, NQH, 

NRH, NAMH, NGK, 

NX, NPHC, NGKQ, 

NGKI, NQZ Two dimensional integer vectors holding the number of rows 
and columns of the matrix shown after the letter N. 

d. COMMON Blocks 
None 
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e. 


Error Messages 


None 


f. Subroutines Employed by DIMSS 
PIFLIB - PRNTITL 

g. Subroutines Employing DIMSS 
PIFLIB - PIFCGT 

h. Concluding Remarks 


None 



M. DISCRETE MODEL CONSTRUCTION (DISCMOD) 


1 . PURPOSE 

Subroutine DISCMOD transforms the continuous-time representations of 
the plant 

x = Fx + Gu (1) 

and model 


x = F x + G u 
- m m - m irm 

to the equivalent discrete representations 


^k+1 


DF x, + DG u, 
— k -=k 


( 2 ) 


(3) 


— m,k+l 


DFM x , + DGM u . 
— m,k — m,k 


(4) 


The controls u, and u , are assumed constant over the uniform sampling 

rC til y K 

interval, DELT. The equations, using the plant dynamics as an example, 
are : 


^ F*DELT 
DF = e 


(5) 


DG 


’ ,DELT F*S , " . „ 

f e ds * G 
o 


( 6 ) 


2 . USAGE 
a. Calling Sequence 

CALL DISCMOD (F, NF, G, NG, FM, NFM, > GM, NGM, DF, DG, DFM, DGM, W9, 
NW9DIM, DELT, DEBUG, ICH) 
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b. Input Arguments 


F, G, FM, 

GM Matrices packed by columns into one-dimensional arrays. 

Not destroyed upon return. 

NF, NG, 

NFM, NGM Two dimensional integer vectors holding the number of rows 
and columns of the matrix shown after the letter N. 

W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 2*(NF(1) ** 2 + 1) 

ICH Two-dimensional logical matrix dimensioned 10 x 15. Sub- 

routines in PIFCGT are called depending on the TRUE or 
FALSE status of elements in ICH. 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

DELT Real scalar containing the sampling time. 

NW9DIM Integer scalar containing the maximum dimension of the W9 
matrix. 

c. Output Arguments 

DF, DG, 

DFM, DGM Matrices packed by columns into one dimensional arrays. 

If ICH (3,1) is TRUE then the matrices contain the discrete 
plant representations. If ICH (3,1) is FALSE then DF, 

DG, DFM, DGM are set equal to F, G, FM, GM. 

d. COMMON Blocks 

None 

e. Error Messages 

If DEBUG is TRUE then DFM, DGM, DF, DG are printed. 
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f. Subroutines Employed by DISCMOD 

ORACLS - NORMS, EXPINT, UNITY, EQUATE, SCALE, NULL, ADD, LNCNT, MAXEL 
PIFLIB - PRNTITL, PRNT 

g. Subroutines Employing DISCMOD 

PIFLIB - PIFCGT 

h. Concluding Remarks 

The ORACLS subroutine EXPINT cannot compute DFM if FM is the null 
matrix. Special logic is used in DISCMOD to circumvent the problem 
in EXPINT. 
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N. DISCRETE PIF CONTROL LAW SIMULATION (DPIFS) 


1. PURPOSE 

The purpose of DPIFS is to simulate the linear PIF control law 
tracking the output of the chosen autopilot model being designed. 
The output of DPIFS is a step by step print out of the simulation. 
The discrete equations simulated by DPIFS are as follows: 


PLANT DYNAMICS 


\+i “ DF \ + 1X5 \ 


PLANT MEASUREMENTS 


= HX x^ + DX u^ 


MODEL DYNAMICS 


x , , . = DFM x . + DGM u . 
m,k+l m,k m,k 


OR 


CLXMOD, CLYMOD, or CLXMOD is called depending on the value of 


PIF CONTROL LAW 


e, =z. -S,,x , , y, =Hx, +Du, , y . =H x . +D u , , 

— k — k 11 — m,k -He — k — k -^irijk tn-m,k m-m,k+l 


v^d-AtC^v^ - 


- AtC. (Hx, ,+Du. - H x -D u ) + E. (u , , . -u ) 

4 -Hc-l — k-1 nr-m,k-l m-m,k 1 —m,k+l — m,k 


-k+1 = + At ^k + S 01 (x ,^-x . ) 

K ^ 21 — m,k+l — m,k 


( 1 ) 

( 2 ) 

( 3 ) 

ICHOSE 

( 4 ) 

( 5 ) 

( 6 ) 
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I 


RELATIONSHIP BETWEEN EQUATION VARIABLES AND DPIFS^ NOTATION 



^k-l 

*k 

*m,k 

zk-1 


DPIFS NOTATION 
Sll 

531 
S2-1 

532 

541 ' 

542 
XM 
XM1 
XM2 

YS(1 , IP+2) 
PU(1, IP) 
PY(1, IP) 
YSSC1, IP) 
YK1 

YX(1, IP) 
PX(1, IP) 

YXK 

EK1 

YU (1, IP) 

EK2 

VK1 

VK2 

YK 

YMK 

YMK1 

PX(1, IP-1) 
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The simulation begins by setting almost all state variables to zero, 
the initial condition starting point. If ICHOSE = 14 (APR GS) , the 
initial value for d is loaded in appropriate locations. If ICHOSE = 

9 (APR LOCI) or ICHOSE = 15 (APR LOCR or APR LOCP) , the initial value 
for y, and the intercept yaw angle are loaded in appropriate locations. 
The initial values for the commands are in UMAG(1,1) and UMAG(2,1) # 
as discussed in HDCON. The starting time at which the command is 
changed from 0.0 to the UMAG value is in USTRT(1,1) and USTRT(2,1). 

The stopping time at which the command is returned to 0.0 is in USTP(1,1) 
and USTP(2,1). The simulation is from 0.0 seconds to (IMAX-2) * DELT 
seconds. All the data from the simulation are stored in two dimensional 
matrices (PX, YX, PU, YU, PY, YSL). The dimensions of these matrices 
limit the value of IMAX (300 for the NAVION autopilot designs) . 

2. USAGE 

a. Calling Sequence 

CALL DPIFS (DEBUG, METERS, DEBUG1 , ICHOSE, ZDDMAX, ZCLOSE, ZDOMAX, 

ZCLMIN, ZCDMAX, VTP, LAMDA, LAMDAGS, GKDSLP, GKDICP, GKDMAX, GKDMIN) 

b. Input Arguments 
ZDDMAX, ZCLOSE, 

ZDOMAX, AK1, 

AK2 , ZCLMAX, 

ZCLMIN, LAMDA, 

ZCDMAX, LAMDAGS, 

GKDSLP, GKDICP, 

GKDMAX, 

GKDMIN Autopilot parameters specified by the designer in NAMELIST. 
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Definitions for these variables are provided in CLXMOD, 
CLYMOD, and CLDMOD documentation. 

DEBUG, 

DEBUG1 Logical scalars indicating the following: 

TRUE: Print out debug information, 

FALSE: Do not print out debug information. 

DEBUG is used in the subroutines CLYMOD, CLXMOD, CLDMOD. 
DEBUG1 is not used. 

METERS If METERS is TRUE then state variables that have units of 
feet are converted to units of meters before print out and 
plotting. 

ICHOSE Integer scalar indicating the desired autopilot design, 
(See HDCON) 

c. Output Arguments 
None 

d. Common Blocks 

DISCSV, WORKS 9 , MODF, PLA, DIMN1 , DIMN3 , DIMN4 , DIMN5 , SMAT, PIFG, 
EIGEN, LABEL, UDIR, GLAD, DISCM, HDXA 

e. Error Messages 

If DEBUG is TRUE then the following matrices are printed out, DFM, 
DGM, UMAG, USTRT , USTP . 

f. Subroutines Employed by DPIFS 
ORACLS - NULL, MULT, ADD, SUBT, EQUATE 

PIFLIB - PRNT2 , FRNTITL, CLXMOD, CLYMOD, CLDMOD 

g. Subroutines Employing DPIFS 
PIFLIB - PIFCGT 
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h. Concluding Remarks 

DPIFS does not include plotting. 
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0. DISCRETE RICCATI EQUATION SOLUTION (DREG) 


1 . PURPOSE 

Subroutine DREG solves the discrete Riccati equation: 

X = PHI T X PHI + QHAT - (GAMA 1 X PHI + AMHAT T ) T * 

(RHAT + GAMA 1 X GAMA)" 1 (GAMA T X PHI + AMHAT T ) (1) 


for X, then computes the feedback gain 
GK = - (RHAT + GAMA 1 X GAMA)" 1 * 

(GAMA T X PHI + AMHATT) (2) 

The solution is obtained using NEWTON'S method as discussed in ORACLS 
documentation of the ASYMREG subroutine. The cross weighting matrix 
AMHAT is eliminated from the quadratic scalar function before solving 
the Riccati equation using the procedure outlined in the ORACLS sub- 
routine PREFIL. If ICH(2,7) is TRUE, the input gain GK must cause the 
closed-loop plant system matrix 

PHICL = PHI + GAMA GK (3) 

to be asymptotically zero. If ICH(2,7) is FALSE the subroutine at- 
tempts to find an initial starting stabilizing gain, GK, using the 
ORACLS subroutine DSTAB. 

2. USAGE 

a. Calling Sequence 

CALL DREG (RHAT, NRH, AMHAT, NAM, QHAT, NQH, GAMA, NGA, X, NX, PHI, 
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NPH, GK, NGK, PHICL, NPHC, ICH, DEBUG, ZERO, NZERO, W9 , NW9DIM, IOP) 
b. Input Arguments 
RHAT, AMHAT, 

QHAT, GAMA, 

PHI Matrices packed by columns into one-dimensional arrays. 

Not destroyed upon return. 

GK Matrix packed by column into a one-dimensional array. 

Destroyed upon return. GK is assumed to contain a stabil- 
izing gain if ICH(2,7) is TRUE. 

W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 9*(NPH(1)*NPH(2) + 1) 

ZERO Work matrix packed by columns into a one-dimensional array. 

All elements must be zero. Dimension must be at least NPH 
(1) * NPH(2) + 1 

ICH Two-dimensional logical matrix dimensioned 10 x 15. Sub- 

routines in PIFCGT are called depending on the TRUE or 
FALSE status of elements in ICH. 

NGK, NX, 

NQH, NAM, NPH, 

NGA, NZERO, 

NPHC Two-dimensional integer vector holding the number of rows 

and columns of the matrix shown after the letter N. NZERO 
is the only vector destroyed upon return. 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

DELT Real scalar containing the sampling time. 
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NW9DIM 


Integer scalar containing the maximum dimension of the W9 


matrix. 

IOP(1)=0 Do not print results. Otherwise print input data, QHAT and 
final values of GK and X. 

IOP(2)=0 Do not print at each iteration. Otherwise regardless of 
printing specified by I0P(1), print iteration count and 
value of X. 

I0P(3) Not Required. 

IOP(4)=0 Do not compute the Riccati equation residual. Otherwise 

compute the residual and print. 

IOP(5)=0 Compute but do not prxnt the eigenvalues of X, the matrix 
(PHI - GAMA GK) and the eigenvalues of (PHI - GAMA GK) . 

Otherwise print these data after computation. 

c. Output Arguments 

X, GK, 

PHICL Matrices packed by columns into one-dimensional arrays 

containing respectively the discrete Riccati equation 
solution, the discrete feedback gain, and the discrete 
closed-loop system matrix. 

NX, NGK, 

NPHC Two dimensional integer vectors holding the number of rows 

and columns of the matrix shown after the letter N. 

d. COMMON Blocks 

None 

e. Error Messages 

If the workspace in the W9 matrix is too small the message "WORK SPACE 

IS TOO SMALL FOR CALCULATION". WORK SPACE = . WC = . 

S3 
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The solution to the RICCATI equation (X) and the gain matrix (GK) are 
always printed out. 

f. Subroutines Employed by DREG 

ORACLS - MULT, SUBT, TESTSTA, SCALE, RICTNWT , TRANP, ADD, EQUATE, EIGEN, 
JUXTC , DSTAB, UNITY, NULL, ASYMREG, 

PIFLIB - PRNTITL, PRNT 

g. Subroutines Employing DREG 
PFICGT 

h. Concluding Remarks 

DSTAB fails consistently in computing a stabilizing gain. An alternate 
method for computing the starting gain is performed by PIFCGT. 
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P. SUBSET OF A MATRIX (EXTR) 


1. PURPOSE 

Subroutine EXTR extracts a matrix from within another matrix. 

2. USAGE 

a. Calling Sequence 
CALL EXTR (A , NA , B , NB , I , J ) 

b. Input Arguments 

A Matrix packed by columns in one dimensional array. Not destroyed 

upon return. 

NA 2 element vector giving number of rows and columns respectively of 

A. Not destroyed upon return. 

NB 2 element vector giving number of rows and columns to be extracted 

into B. Not destroyed upon return. 

I & J Define upper left hand corner position of B as a row and column 
position in A. 

c. Output Arguments 

B Matrix that is extracted. Packed column wise into one 

dimensional array. 

d. COMMON Blocks 
None 

e. Error Messages 

If either NA(1) < NB(1), or NA(2) < NB(2), or NA(1) x NA(2) < 1, or 

NB(1) x NB(2) < 1, the message is "DIMENSION ERROR IN CORNER NA = 

NB = " is printed and the program is returned to the calling 

point. 
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f. Subroutines employed by EXTR 
None 


g. Subroutines employing EXTR 
PIFLIB - CFWM, PIFPLC, PIFG, HADAC. 

h. Concluding Remarks 

This routine is useful for extracting relevant sub-matrices from within 
a partitioned matrix as shown below. 


J NB(2) + J 
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Q. F AND G CONSTRUCTION FROM AERODYNAMIC COEFFICIENTS (FGAERO) 


1. PURPOSE 

Subroutine FGAREO accepts nondimensional aerodynamic coefficients, 
trim conditions, and a desired velocity magnitude and constructs the 
aircraft perturbation model matrices F and G at the trim condition 
specified by the desired aircraft velocity, where 

Ax = F Ax + G Au (1) 

A derivation of the perturbation aircraft dynamics based on the non- 
linear dynamics is summarized in Ref. 1. Information on the notation 
used in the following discussion can be found in Ref. 1, Appendix A. 

The F and G matrices are partitioned as follows: 



The state and control vectors are 

[Av^ Au)^ Av^ Ax^l = [Au Av Aw Ap Aq Ar A<j> A0 At|> Ax Ay Az] (3) 

— B — B B ~ E 
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( 4 ) 


Au T = [A6_ A6 AS AS ] 

— 1 T e a r 

Av = [A3 Act] (5) 


The effect of Av^ is included after the above partitions have been com- 
puted. The partitioned matrices in Eq. 2 satisfy the following: 


All = FBV - WBI + FBAB*AU 
A12 = VBT + FBW 
A13 = NBV 

A21 = IB _1 *(GBV + GBAB*AU) 

A22 = IB _1 *GBW - IBIB 

A3 2 = LB _1 

A33 = LBLB 

A41 = (HBI) T = HIB 

A43 = -(HIB*VB)*HIB*LB 


FI = 0 

F2 = IB _1 *GBABD 


B 1 1 = FBU 


B21 = IB ^GBU 


LB = 


1 0 
0 cos(pHIo) 
0 -sin(pHIo) 


-sin (THETAO) 
sin^PHIo) cos (THETAO) 
cos(pHIo) cos (THETAo) 


' 4 > " 


“PO * 

e 

= LB 

QO 

A. 


- R0 - 


LB * WB 


( 6 ) 

(7) 

( 8 ) 

(9) 

( 10 ) 
(ID 
( 12 ) 

(13) 

(14) 

(15) 

(16) 

(17) 

(18) 

(19) 


( 20 ) 
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LBLB 


VB = 


VBT = 


WB = 


WBI = 


HBI = 


GG = 


0 tan (thetao) 
4 cos (thetao) 


(t 


L 0 SEC (THETAO ) 


ip SEC (tHETAo) 
0 

ip TAN (THETAO) 


0 

0 

0. . 


UO ' 

VO 

wo 


r o -wo vo 


WO 0 -UO 


= VB 


-VO UO 0 J 


PO 

qo 

. RO . 


( 21 ) 


( 22 ) 


(23) 


(24) 


“ 0 

-RO 

QO " 

r — > 






RO 

0 

-PO 

= WB 






.-QO 

PO 

0 . 

- 






' l 


0 

0 


~ cosl 

'thetao) 

0 

sin (THETAO) 

0 

cos 

^PHIo) 

sin (PHIO) 

* 


0 

1 

0 

_ 0 

-sin 

'PHIo) 

cos(PHI0)_ 


. sin 

'thetao) 

0 

cos(tHETAo) 



r* 




”1 




(25) 




cos 


* 

-sin 



- 

G5“ 


' 0 “ 

G6 

= HBI * 

0 

G7 _ 


_GR . 


1 J 


(26) 


(27) 
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r 0 -G7 G6”l 


GB 


G7 



-G6 G5 0 


(28) 


(The subroutine CROSSP forms the cross produce equivalent matrix, GB, 
from the vector GG ) 


IB = 


IX 0 0 

0 IY 0 

0 0 IZ 


IBIB = IB -1 * [WBI*IB - (IB*WB) ] 


(29) 


(30) 


S = RHO * A * 0.5 

(31) 

AMASSI = GR/WT 

(32) 



' CXO*UO 

CXO*VO 

CX0*W0 " 

FBV = 2*S* 

CYO*UO 

CY0*V0 

CYO*WO 


_CZO*UO 

czo*vo 

czo*wo _ 



~B*CXP 

C*CXQ 

B*CXR " 

FBW = 0. 5*S*VT0* 

B*CYP 

C*CYQ 

B*CYR 


_B*CZP 

C*CZQ 

B*CZR _ 


FBAB = S*VT0**2 * 


CXB 

CYB 

LCZB 


CXA 
CYA 
CZA . 



CXDT 

CXDE 

CXDA 

CXDR" 

FBU = S*VT0**2 * 

CYDT 

CYDE 

CYDA 

CYDR 


-CZDT 

CZDE 

CZDA 

CZDR _ 


(33) 


(34) 


(35) 


(36) 
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rB*CLO*UO B*CLO*VO 


B*CLO*WO 


GBV = 2*S * 


C*CMO*UO 

B*CNO*UO 


C*CMO*VO 

B*CNO*VO 


C*CLO*WO 
B*CNO*WO _ 



“B*CLB 

B*CLA" 

GBAB = S*VT0**2 * 

C*CMB 

C*CMA 


_B*CNB 

B*CNA _ 


GBW =0.5 *S*VTO * 


B**2*CLP B*C*CLQ 
B*C*CMP C*C*CMQ 
_ b**2*CNP B*C*CNQ 


B*B*CLR " 
B*C*CMR 
B*B*CNR _ 



"B*CLDT 

B*CLDE 

B*CLDA 

B*CLDR~ 

GBU = S*VT0**2 * 

C*CMDT 

C*CMDE 

C*CMDA 

C*CMDR 


_B*CNDT 

B*CNDE 

B*CNDA 

B*CNDR . 


GBABD = 0.5*S*VT0 * 


" B*B*CLBDOT 
B*C*CMBD0T 
B*B*CNBD0T 


C*C*CLADOT 
C*C*CMADOT 
B*C*CNADOT . 


AU 


0 

WO 

U0**2+W0**2 


1.0 

VTO 

0 


0 

UP 

UO**2+WO**2 


ABV = 


0 

0 


VTO 

0 


0 

1 

VTO 


Z = I - ABV * FI 


Gl = Z 1 [ABV*A11 ABV*A12 ABV*A13 0] 


G2 = Z 1 * ABV * B1 


(37) 


(38) 


(39) 


(40) 


(41) 


(42) 


(43) 

(44) 


(45) 
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The effect Av^ is included to produce the final form for F and G 


Av = G1 x + G2 u 
— w — — 


F = F + 


0 ' 
F2 
0 
0 


* G1 


(46) 

(47) 


G = G + 


0 

F2 

0 

0 


* G2 


(48) 


After F and G have been constructed the states are reordered as follows: 


Ax = [Au Aw Aq A8 Az Ax Av Ar Ap A<}> A^ Ay] 


(49) 


completing the linear time- invariant aircraft model construction. If 

ICH(1,5) is TRUE, the units are changed from radians to degrees. 

2. USAGE 

a. Calling Sequence 

CALL FGAERO (DEBUG, ICH, HBI, NHBI, LB, NLB) 

b. Input Arguments 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

ICH Two-dimensional logical matrix dimensioned 10 x 15. Sub- 

routines in PIFCGT are called depending on the TRUE or FALSE 
status of elements in ICH. 

c. Output Arguments 

HBI, LB Matrices packed by columns into one dimensional arrays. 

NHBI, NLB Two dimensional integer vector holding the number of rows 
and columns of the matrix after the letter N. 
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d. COMMON Blocks 

PLA, GLAD, DIMN4, AERO, WORKS9 , HDXA 


e. Error Messages 

If the LB matrix is not invertible the message "LB IS A SINGULAR 
MATRIX" is printed and the program stops. If the Z matrix is not in- 
vertible the message "Z IS A SINGULAR MATRIX" is printed and the program 
stops. If DEBUG is TRUE the following statements and matrices are 
printed during the course of program execution 
*** s = 

*** AMASSI = 


LB, HBI, GB, NBV, LB _1 (LB1), LBLB , IB, IB -1 (IB1), IBIB, FBV, FBW, FBAB, 
FBU, GBV, GBAB, GBW, GBU, GBBD, All, A12, A13. 

A1 The F matrix in Eq. 2, before including the effect of AD and 

w 

the position states Ax^, 


Bll , B21, 

B31, B1 The G matrix in Eq. 2, before including the effect of Av^ and 
the position states Ax„ 

Ci 

Fll, F21, F31, FI, Z, Z _1 (ZINV) , Gl, G2, 

FORD The A1 matrix including the effect of Av^ 

GHIA The B1 matrix including the effect of Av^ 

If ICH(1,5) is TRUE then the following are printed 
FDEG The F matrix in Eq. 1 using degree units 

GDEG The G matrix in Eq. 1 using degree units 

f. Subroutines Employed by FGAERO 


ORACLS - EQUATE, MULT, UNITY, GELIM, DETFAC , GAUSEL, SUBT, SCALE, ADD, 
JUXTC, JUXTR 

PIFLIB - PRNTITL, PRNT, MOVEALL, CORNER, DIAGPAR, CROSSP, R3MAT 
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g. Subroutines Employing FGAERO 
PIFLIB - PIFCGT 

h. Concluding Remarks 


None 



R. EIGENVALUES /EIGENVECTORS OF CLOSED-LOOP PLANTS USING CSQZ (FREEF) 


1 . PURPOSE 

The purpose of FREEF is to compute eigenvalues, A , and eigenvectors, 
x, of the matrix, F, where 

Fx = Ax , A = R + jl (lq, b) 

FREEF assumes F is a closed-loop plant matrix 

F = A + BK (2 ) 

so that eigenvalues of F are interpreted as indications of closed- 
loop stability. FREEF uses the NASA Langley FTNMLIB subroutine CSQZ. 

CSQZ uses Householder transformations and a combination of the double 
shift QZ iteration and the single shift implicit QZ iteration. Consult 
Section 2h for further remarks. 

2 . USAGE 

a. Calling Sequence 

CALL FREEF (F, ER, El, V, WK, IFREE, N) 

b. Input Arguments 

F Matrix packed by columns into one-dimensional array. 

Destroyed upon return. 

EFREE Integer scalar for eigenvalue computations 

0 - No calculation in FREEF 

1 - Compute and print eigenvalues 

2 - Compute and print eigenvalues and eigenvectors 

N Integer scalar indicating row dimension of the square 

matrix F. 
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WK 


Work matrix of dimension at least 2*(N**2+1) 


c. Output Arguments 

ER Real vector containing the real part of the eigenvalues in 

ascending order of magnitude 

El Real vector containing the imaginary part of the eigenvalues 

in ascending order of magnitude 

WK Real matrix containing the eigenvectors packed by columns 

into a one-dimensioned array. A real eigenvector is placed 
in one column. A complex eigenvector is placed in two columns. 
The real part is placed in the first column. The imaginary 
part of the positive complex eigenvector pair is placed in 
the second column. The arrangement is in ascending order 
of magnitude. 

d. COMMON Blocks 

None 

e. Error Messages 

After CSQZ is called, the following is printed: 

OUTPUT OF CSQZ IN FREE 

EPSA = EPSB = IERR = 

Eigenvalues are calculated as (c^+ja^/g. EPSA is the inaccuracy level 

of la^+ja^l- (Digits below this level are known to be inaccurate). 

EPSB is the inaccuracy level of 0. IERR is an error code. 

IERR = 0 normal return. 

= I Ith eigenvalue ratio has not been determined after 30 
iterations. 

If 0 is zero for eigenvalue I the following is printed: 

EIGENVALUE PROBLEM IN CSQZ IN FREE: BETA IS ZERO I = 
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Additional information for each eigenvalue is printed with the following 


EIGENVALUES The values for the eigenvalues R and jl 

TIME CONSTANT -1.0/R - Time to reach 63.212% of a step command 

50 PERCENT 

SET TIME 0.6931472*(-1.0/R) - Time to reach 50% of a step command 

10 PERCENT 

SET TIME 2. 302582* (-1.0/R) - Time to reach 90% of a step command 

2 PERCENT 

SET TIME 3 . 9120230* (-1. 0/R) - Time to reach 98% of a step command 

UNDAMPED 

NAT FREQ (R**2+I**2) - Undamped natural frequency of a complex 

eigenvalue 

RATIO -R/ (R**2+I**2) - Damping ratio of a complex eigenvalue 

RISE TIME 0. 5* (6 .28318531) / j I | - TAN -1 (|l|/R)/|l| - time for the 

step response of a complex eigenvalue to cross the step 
command the first time. 

PERIOD 6. 28318531/ | I | - Time for a complex eigenvalue to com- 

plete one oscillation. 

OVERSHOOT 100.0* e (° - 5*R*6 . 28318531/ | T | ) _ The overshoot of a sta ble 

complex eigenvalue in response to a step input. 

f. Subroutines Employed by FREEF 
ORACLS - UNITY 

PIFLIB - RESPON 
FTNMLIB - CSQZ 

g. Subroutines Employing FREEF 
None 
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h. Concluding Remarks 

A user with access to the subroutine CSQZ should replace the call to 
FREEO with a call to FREEF in the following subroutines - PIFCGT, 
PIFEIG, PIFPLC, PIFFRE. A user without access to CSQZ should remove 
the subroutine FREEF from the software package. 



S. EIGENVALUES /EIGENVECTORS OF CLOSED-LOOP PLANTS USING EIGEN (FREEO) 


1. PURPOSE 

The purpose of FREEO is to compute eigenvalues, X, and eigenvectors, 
x, of the matrix, F, where 

Fx = ^2£ , X = R + jl (la, b) 

FREEO assumes F is a closed-loop plant matrix 

F = A + BK (2) 

so that eigenvalues of F are interpreted as indications of closed-loop 
stability. FREEO uses the ORACLS subroutine EIGEN. EIGEN balances 
the matrix and the eigenvalues are found by stabilized elementary 
similarity transformations and the double shift QR algorithm. 

2. USAGE 

a. Calling Sequence 

CALL FREEO (F, ER, El, V, WK, IFREE , N) 

b. Input Arguments 

F Matrix packed by columns into one-dimensional array; de- 

stroyed upon return. 

IFREE Integer scalar for eigenvalue computations 

0 - No calculation in FREEF 

1 - Compute and print eigenvalues 

2 - Compute and print eigenvalues and eigenvectors 

N Integer scalar indicating row dimension of the square matrix 

F 

WK Work matrix of dimension at least 2*(N**2+1) 
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c. Output Arguments 

ER Real vector containing the real part of the eigenvalues in 

ascending order of magnitude 

El Real vector containing the imaginary part of the eigenvalues 

in ascending order of magnitude 

WK Real matrix containing the eigenvectors packed by columns 

into a one-dimensional array. A real eigenvector is placed 
in one column. A complex eigenvector is placed in two columns. 
The real part is placed in the first column. The imaginary 
part of the positive complex eigenvector pair is placed in 
the second column. The arrangement is in ascending order 
of magnitude. 

d. COMMON Blocks 
None 

e. Error Messages 

After EIGEN is called and if IERR (defined in EIGEN documentation) is 
nonzero the value of IERR is printed out. Additional information for 
each eigenvalue is printed with the following banners: 

EIGENVALUES The values for the eigenvalues R + jl 

TIME CONSTANT -1.0/R - Time to reach 63.212% of a step command 

50 PERCENT 

SET TIME 0. 6931472* (-1.0/R) - Time to reach 50% of a step command 

10 PERCENT 

SET TIME 2. 302582*(-1.0/R) - Time to reach 90% of a step command 

2 PERCENT 

SET TIME 3. 9120230* (01. 0/R) - Time to reach 98% of a step command 

UNDAMPED 

NAT FREQ (R**2+I**2) - Undamped natural frequency of a complex 

eigenvalue 
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-R/ (R**2+I**2) - Damping ratio of a complex eigenvalue 
0.5* (6. 28318531/ | l|) - TAN -1 (|l|/R)/|l| - Time for the 
step response of a complex eigenvalue to cross the step 
command the first time. 

6 . 28318531/ | I | - Time for a complex eigenvalue to com- 
plete one oscillation. 

mn o* (0.5*R*6. 28318531/ 1 1 J ) f 

100.0* e 1 1 - The overshoot of a 

stable complex eigenvalue in response to a step input. 

f. Subroutines Employed by FREEF 
ORACLS - UNITY EIGEN 

PIFLIB - RESPON 

g. Subroutines Employing FREEF 
PIFCGT , PIFEIG, PIFPLC , PIFFRE 

h. Concluding Remarks 
None 


RATIO 
RISE TIME 

PERIOD 

OVERSHOOT 
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T. ACCELERATION AND VELOCITY VECTOR OBSERVATION MATRIX CONSTRUCTION (HAD AC) 


1 . PURPOSE 

HADAC constructs the 3x13 and 3x4 observation matrices HAC and DAC 
and the 3x12 observation matrix HAB. HAC and DAC initially are the 
body-mounted perturbation accelerometer observation matrices and satisfy 


Aa fi = HAC Ax + DAC Au (1) 

where Aa^ is the perturbation body-axis accelerometer output, 

Aa^ = [Aa Aa Aa ] (2) 

— B x y z 

Ax is the perturbation aircraft state vector 
T 

Ax = [Au Aw Av Ap Aq Ar Ac}> A6 A^ Ax Ay Az] (3) 


Au is the perturbation aircraft control vector 

Au T = [AS AS AS AS ] (4) 

— Tear 

The units must be feet and radians. 

HAB is the perturbation observation matrix for total velocity, . , 

AV , sideslip, A8 and angle of attack, Aa, where 

An = HAB Ax (5) 

and 


An = 


'AV 

A3 


( 6 ) 


LAa J 

The construction of HAC and DAC proceeds by first partitioning the 


12x12 plant system matrix, F, and 12x4 control matrix, G, as follows 
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(7) 


F = 


G = 


"FXX 

FXW 

FXV 

FWX 

FWW 

FWV 

FVX 

FVW 

FW 

_FPX 

FPW 

FPV 

"gxu ~ 

GWU 

GVU 

_ 0 _ 




0 

0 

0 

0 . 


( 8 ) 


The expressions for HAC, DAC, and HAB become (see Ref.l for a deriva- 
tion) 


HAC = [H 1 H 2 H 3 0] (9) 

H x = FXX + TW - TSB * FWX (10) 

H 2 = T (TXB*W) - TW * TXB - TVB + FXW - TXB * FWW (11) 


H 3 “ 

FXV - 

TXB * FWV - 

GB * LB 


(12) 

where 

"1.0 

0 

-sin (THETAO) 



-LB = 

0 

cos (PHIO) 

sin (PHIO) * cos 

(THFTAO) 

(13) 


. 0 

-sin (PHIO) 

cos (PHIO) * cso 

(THETA0)_ 


HBI = 

T 

HIB 




(14) 

HIB = 

T * 
1 

T * T 

2 3 



(15) 


T 


1 


cos (PSIO) 
sin (PISO) 
0 


-sin (PSIO) '0 ‘ 

cos (PISO) 0 

0 1.0 


cos (PHIO) 


L-sm (PHIO) 


'0 sin (PHIO)" 
1.0 0 
0 cos (PHIO). 


(16) 


(17) 
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1.0 


0 


0 


0 cos (THETAO) -sin (THETAO) 

0 sin (THETAO) cos (THETAO) 


(18) 



0 

pi 

1 

o 

Q0 - 

TW = 

RO 

0 

-P0 


o 

n. 

o 

O' 

0 


' 0 

-zs 

xs“ 

TXB = 

zs 

0 

-ys 


_-xs 

-ys 

0 _ 


" 0 

-WO 

no 

VBT = 

WO 

0 

-VO 


--U0 

VO 

o . 

' g l' 
g 2 = 
- g 3- 

= HBI 

-o " 
0 

_8 - 


GB = 

0 -g 

g 3 0 

-S 1 8 

3 

2 

8 1 

S 2 

0 


X l" 


■po " 

X 2 

= TXB * 

Q0 

X 3- 


.RO . 



- 0 

“ X 3 

v 

T(TXB*W) = 

X 3 

0 

“ X 2 


_- X l 

X 2 

0 


(19) 


( 20 ) 


( 21 ) 


( 22 ) 


(23) 


(24) 


(25) 
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DAC = [GXU - TXB * GWU] 


(26) 


where 


HAB = [JW * HWB 000] 


JW 


1.0 0 

1.0*DPR 

Vt 

i o 

0 0 


0 

0 

1.0*DPR 

(V Tq cosB 0 ) 


HWB = HBW 


(27) 


(28) 


(29) 



“cosg 

o 

O 

-sing 

o 


cosB 

o 

sing 

o 

0 

HBW = 

0 

1.0 

0 


~ sin6 0 

cosB 

0 

o. 


_sinB 

o 

0 

cos3 

cr 


0 

0 

1.6. 


(30) 


DPR = 180.0/ 7T 


2 2 2 

v T = >Juo + VO + WO 

o 

6 = sin" 1 (V0/V T ) 

O 1 

o 

a = tan ^ (W0/U0) 
o 


(31) 


(32) 

(33) 

(34) 
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If ICH(2,12) is TRUE, Aa^ observation is replaced with velocity magni- 
tude, AV, observation in HAC DAC by replacing the first row in HAC 

with the first row in HAB and zeroing out the first row in DAC. In 

a similiar manner if ICH(2,13) is TRUE, Aa^ observation is replaced 

with sideslipe observation, Ag, and if ICH(2,14) is TRUE, Aa observa- 

z 

tion is replaced with angle-of-attack observation, Aa. 

2. USAGE 

a. Calling Sequence 

CALL HADAC (LB, NLB, VBT, NVBT, GB, NGB, DEBUG, F, NF, G, NG, XS, 

YS , ZS ’ P0 » Q°» R0 uo » VO, WO, HAC, DAC, ICH, NGAC, NDAC, HAB, NHAB) 

b. Input Arguments 

LB, GB, F, 

G, VBT Matrices packed by columns into one-dimensional arrays; 

not destroyed upon return. These matrices are constructed 
in FGAERO 

NLB, NVBT, 

NGB, NF, NG Two-dimensional integer vector holding the number of rows 
and columns of the matrix shown after the letter N. 

XS, YS, 

ZS Real scalars containing the x, y, and z body axis position 

of the accelerometers with reference to the aircraft center 
of gravity. 

PO, QO, RO, 

UO, VO, WO Real scalar trim conditions for roll rate, pitch rate, yaw 
rate, body-axis forward velocity, lateral velocity and 
vertical velocity, respectively. 

ICH Two-dimensional logical matrix dimensioned 10x15. 
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Subroutines in PIFCGT are called depending on the TRUE or FALSE status 
of elements in ICH. 

c. Output Arguments 
HAC, DAC, 

HAB Matrices packed by columns into one-dimensional, arrays 

NHAC, NDAC, 

NHAB Two-dimensional integer vector holding the number of rows 

and columns of the matrix shown after the letter N. 

d. COMMON Blocks 
W0RKS9 

e. Error Messages 

If DEBUG if TRUE the following matrices are printed our during the 
course of program execution: FXX, GXU, JW*HWB(JHWB) , HAB, HAC, DAC. 

f. Subroutines Employed by HADAC 

ORACLS - NULL, MULT, SUBT, ADD, JUXTC, TRANP, UNITY 
PIFLIB - CROSSP , EXTR, PRNT, PRNTITL 

g. Subroutines Employing Hadac 
PIFLIB - FGAERO 

h. Concluding Remarks 
None 
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U. FM, GM, HM, DM. H AND D MATRIX CONSTRUCTION (HDCON) 


1. PURPOSE 

The purpose of HDCON is to construct the FM, GM, HM, DM, H and D 
matrices, to set up the XR, UR, YR, XMR, UMR logical vectors used 
by the REMAT subroutine, and to modify the XR, UR, YR, and UMR vectors 
as needed to reflect changes from initial specifications in AEROD 
(BLOCK DATA). The program has the necessary information for each 
command system that is chosen by the designer using ICHOSE. For 
each value of ICHOSE supported by the program, (ICHOSE - 4 is avail- 
able but not supported), the values for elements FM, GM, HM, H and D 
are shown in Ref. 1, Appendix C. The program constructs the matrices 
assuming the aircraft states and controls have the following order, 

T 

Aj? = [Au Aw Aq A0 Ax Az Av Ar Ap A(f> Aij; Ay] (1) 

Au T = [A5 A6 A6 A6 ] (2) 

— Tear 

The order for Ay, Ay , Ax , and u are the same as the order in Ref. 1. 

^-m — m — m 

After constructing the matrices, the states and controls which are 
to be eliminated are identified by setting appropriate elements in XR, 

UR and YR to FALSE. The order for XR and UR are the same as Eqs. 1 and 

2. The first two elements in YR are assumed to be longitudinal. The 
latter two elements in YR are assumed to be lateral. 

The weighting elements for the integrator states, (Z1Q, Z2Q, Z3Q, 
Z4Q) , have the same order as YR. Integrator states are eliminated in 
REMAT using the YR logical vector. The values for NM, the number of 
command model controls are specified in HDCON for each ICHOSE value. 
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The values for L, N, and M are always 4, 12 and *4, respectively. REMAT 
changes these values depending on XR, UR, and YR. The plotting labels 
in YL must be -changed to reflect different command systems. The first 
two rows irl YL are assumed to be longitudinal. The latter .'two rows 
in YL are assumed to be -lateral. Rows in YL are eliminated - in REMAT 
using the YR logical vector. 

2. USAGE 

a. Calling Sequence- 

CALL HD CON (H, NH, D, ND, FM, NFM, GM, NGM, HM, NHM, DM, NDM, ICHOSE, 
W9, NW9DIM, UO, WO, QO, RO, ,VTO, THETAO , PHIO, DEBUG, METERS, XR, UR, 
YR, XMR, UMR, ICH, HAC, NHAC , DAC, NDAC , GR, N, M, L, NM, MM, XL, YL, 
GKPSI, GKY, F, LAMDA, ZETA) 

b. Input Arguments 

F The 12 x 12 aircraft system matrix packed by columns in a. 

one-dimensional array. The F matrix is constructed in- 
FGAERO. The-F matrix is altered if ICHOSE = 14. 

ICH Two-dimensional logical matrix dimensioned 10 x 15. 

Subroutines in PIFCGT are called depending on the TRUE or - 
FALSE status of elements in ICH. 

W9 Work matrix packed- by columns into a one-dimensional array. 

Dimension must be at least '7* (n + m + 1). 

DEBUG Logical scalar indicating the. following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information. 

NW9DIM Integer- scalar containing the maximum dimension- of the W9 

matrix. 
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UO, WO, QO, 


RO, THETAO , 
LAMDA, ZETA 
VTO, PHIO 


ICHOSE 


Trim values for the states. The trim values are obtained 
from linear interpolation in INTERP. LAMDA is the flight 
path angle in degrees (LAMDA = 0.0 deg usually). ZETA is 
the ground relative heading angle in deg (ZETA = 0.0 usually). 
Integer scalar indicating the desired autopilot designs 
as follows: 


ICHOSE 
1-BETA HOLD 


6-HDG SEL 


7-ALT SEL 


9-APR LOCI 


DESCRIPTION 

Beta and roll angle constant command system 
for lateral dynamics. Beta and roll angle 
perturbation commands for DPIFS simulation 
are in UMAG(1,1) and UMAG (2,1), respectively. 
Yaw angle outer loop turning command system 
using the ROLL HOLD command system as the 
inner loop structure. Yaw angle and rudder 
position perturbation commands for DPIFS 
simulation are in UMAG(1,1) and UMAG(2,1). 
Altitude select command system for longitudinal 
dynamics. Altitude perturbation command is 
in UMAG (1,1). 

Localizer tracking model for lateral dynamics. 
Perturbation lateral position offset is in 
UMAG (1,1). Yaw intercept angle is in UMAG (2,1). 
USTRT(1,1) and USTRT(2,1) must be at 0.0. 
USTP(1,1) and USTP(2,1) must be at desired 
final time. 
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12-ROLL HOLD 


METERS 


HAC, DAC 


NHAC, NDAC 


GR 

N, M, L, 
NM, MM 


Roll angle and rudder angle constant command 
system. Roll and rudder angle perturbation 
commands are in UMAG(1,1) and UMAG(2,1). 

14- APR GS ' Glideslope position error (d) tracking command 

system. UMAG(1,1) contains the d position 
offset at beginning of simulation. USTRT(1,1) 
should be 0.0. z dynamics in F and G are 
replaced with d dynamics in HDCON. 

15- APR LOCR Lateral position (y) localizer outer loop 

command system using the HDG SEL command system 
as the inner loop structure. Same simulation 
requirements as ICHOSE = 9. 

16- APR LOCP Lateral position (y) localizer outer loop 

command system using the ROLL HOLD command 
system as the inner loop structure. Same 
simulation requirements as ICHOSE = 9. 

Logical scalar indicating when units of control law should 
be changed to meters and radians. 

Matrices packed by columns into one-dimensional arrays. 

These matrices are determined in HADAC. 

Two-dimensional integer vector holding the number of rows 

and columns of the matrix shown after the letter N. 

„ , 2 

Gravity m ft/sec . 

Integer values indicating initial values for dimension of 
matrices, N= 12, M= 4, L=4, NM= 2, MM= 2. Changed 
upon return; 
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GKPSI Outer loop yaw angle guidance gain for HDG SEL and APR LOCR 

autopilot modes. 

SKY Outer loop lateral position guidance gain for APR LOCR and 

APR LOCP autopilot modes. 

XL, YL Label arrays for printout in DPIFS. Some of the elements in 

the array are altered upon return. 

c. Output Arguments 
H, D, FM, 

GM, HM, DM Matrices packed by columns into one-dimensional arrays. 

NH, ND, 

NFM, NGM, 

NHM, NDM Two-dimensional integer vector holding the number of rows 
and columns after the letter N. 

XR, UR, YR, 

XMR, UMR Logical arrays containing TRUE and FALSE information for 
subroutine REMAT. 

N, M, L, 

NM, MM Integer values indicating maximum dimensions for matrices. 

XL, YL Label values for plots matching choise of AUTOPILOT mode. 

d. Common Blocks 
None 

e. Error Messages 

If the W9 matrix is too small the statement "THE W9 MATRIX IS TOO SMALL" 
is printed. 

if ICHOSE = 1 and ICH(2,9) is FALSE or ICH(2,13) is FALSE then "ERROR ?? 
ICH BETA BAD" is printed. 
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If DEBUG is TRUE the following matrices are printed out during the 
course of program execution. 

VXYZ - A 3 x N matrix containing the Ax, Ay, Az dynamics extracted 
from the F matrix. 

LAMD - A 1 x N vector containing the row in F that represents the Ad 
dynamics. 

H(HCON) , D(DCON), FM(FMCO) , GH(GMCO) , HM(HMCO) , DM(DMCO) 

f. Subroutines Employed by HDCON 
ORACLS - MULT, NULL, PRNT , SCALE 
PIFLIB - PRNTITL, PRNT 

g. Subroutines Employing HDCON 
PIFLIB - PIFCGT 

h. Concluding Remarks 
None 
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V. INTERPOLATE AERODYNAMIC DATA (INTERP) 


1. PURPOSE 

Given the aerodynamic coefficients and trim conditions of two flight 
conditions at different forward velocities, the subroutine INTERP in- 
terpolates between the data points to find estimated intermediate aero- 
dynamic coefficients and trim conditions. 

2. USAGE 

a. Calling Sequence 
CALL INTERP (VTP) 

b. Input Arguments 

VTP Real scalar containing the forward velocity in fps at which 

the interpolation is to occur 

c. Output Arguments 
None 

d. COMMON Blocks 

AERO, AER1 

The interpolation overwrites the values in the AERO common block. The 
AERO common block is used elsewhere in the program scalled by PIFCGT 

e. Error Messages 
None 

f. Subroutine Employed by INTERP 

PIFLIB - PRNTITL 

g. Subroutines Employing INTERP 

PIFCGT 

h. Concluding Remarks 
None 
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W. MULTIPLY A TRANSPOSE TIMES B TIMES A (MATBA) 


1. PURPOSE 

Form Matrix Product A^BA where B must be symmetric. 

2. USAGE 

a. Calling Sequence 

CALL MATBA (A,NA,B,NB,C,NC,W1,NW1) 

b. Input Arguments 

A,B Input matrices packed by columns in one-dimensional arrays; 

not destroyed. B must be symmetrical. 

NA,NB Two-dimensional vectors giving number of rows and columns of 
respective matrices; for example: 

NA(1) = number of rows of A 
NA(2) = number of columns of B 
Not destroyed upon return. 

W1 Input workspace vector of length NB(1> x NA(2) or greater 

NW1 Vector of length two for workspace 

c. Output Arguments 

T 

C Product A A BA packed by columns in one-dimensional array. 

NC Two-dimensional vector containing rows and columns in C. 

NC (1) = NA(2) 

NC (2) = NA(2) 

d. COMMON Blocks 

None 

e. Error Messages 

None 


90 




f. Subroutines employed by MATBA: 


MULT 


g. Subroutines employing MATBA: 

PIFLIB - CFWM 

h. Concluding Remarks 

B is not checked to see if it is symmetric. 



X. REARRANGE MATRIX (MOVEALL) 


1. PURPOSE 

Subroutine MOVEALL rearranges the rows (columns) of a matrix with the 

option of taking a subset of the rows (columns). 

2. USAGE 

a. Calling Sequence 

CALL MOVEALL (A,NA,B,NB,IDEX,IHOW) 

b. Input Arguments 

A Matrix to which manipulations are to be performed packed by 

columns in one dimensional array; not destroyed. 

NA Two-dimensional vector giving number of rows and columns' in A. 

NA(1) = Number of rows in A 
NA(2) = Number of columns in A 
Not destroyed. 

IHOW Flag for type of manipulation IHOW = 1 - work with rows, 

IHOW = 2 - work with columns . 

IDEX Position dependent index vector. IDEX(l) contains the number 

of the row (column) in A that will become the first row (column) 
in B and so forth. All unused positions in IDEX must be- zero 
especially when working columns. Therefore if IDEX has its first 
5 elements non-zero then B will contain only 5 rows (columns) from 
A. IDEX thus allows rearranging and deleting rows (columns) at 
the same time. 

c. Output Arguments 

B Contains the manipulated results from A packed by columns in 

a one-dimensional array. 
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NB Two-dimensional vector contain dimensions of B 

NB(1) = Number of rows in B 
NB(2) = Number of columns in B 

d. COMMON Blocks 
None 


e. Error Messages 

If NA(1) < NB (1) or NA(2) < NB(2), the message "DIMENSION ERROR IN MOVEALL 

NA = , NB = " is printed and the program is returned 

to the calling point. 

f. Subroutines employed by MOVEALL 
None 


g. Subroutines employing MOVEALL 
PIFLIB - REMAT, FGAERO 

h. Concluding Remarks 

Example: IDEX = [ 3 , 1, 2, o] 

IHOW = 1 


A = 


a 

e 

n 

t 


bed 
f g h 
p q r 

V W X _ 


then 



It is good practice to zero out IDEX before constructing it since non-zero 
elements detected after a zero element causes problems. 
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Y. PIF EIGENVALUE PLACEMENT (PIFEIG) 


1. PURPOSE 

The objective of PIFEIG is to compute a closed-loop model matrix, FM, 
with stable eigenvalues. Subroutine PIFEIG computes a desirable closed- 
loop model matrix for the implicit model following design method in the 
subroutine PIFPLC. Ultimately, PIFPLC computes an initial stabilizing 
feedback gain for the subroutine DREG. 

If ICH(2,11) is TRUE, PIFEIG computes a random feedback gain, GK, 
using the subroutine RANF. If ICH(2,11) is FALSE, PIFEIG assumes GK 
contains an initial starting gain. The eigenvalues and eigenvectors 
of the closed-loop plant, F+G*GK are computed using the subroutine FREEF 
and satisfy the following relationship 

T A T _1 - F + G * GK (1) 


A is a complex diagonal matrix containing the eigenvalues, A^. T is a 

complex matrix containing the eigenvectors. If IE(i) is equal to 1, the 
th 

i eigenvalue of A is adjusted as follows: 

eigenvalue A^ = a. ± j b. 

stabilized a. = - a. I 
l ' 

After eigenvalue stabilization, the real and imaginary parts of the eigen- 
vector matrix, T=W9 (LW8)±jW9 (LW10) , are used to form the real matrix, FM, 
as follows. 


[= 


W9(LW8) 

W9 (LW10) 

W9 (LW1) 

W9(LW2) 

W9(LW8) 

W9 (LW10) 

W9(LW10) 

W9(LW8) 

-W9 (LW2) 

W9 (LW1) 

_-W9 (LW10) 

W9(LW8) _ 


-1 


ETMA 


EIMA 


ETMA' 


-1 


r fm 

Lil 

1 "o~ J 

fm 

L. 

-i 


( 2 ) 
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The matrix W9(LW1) is a diagonal matrix containing the real part of 
the stabilized eigenvalues of F+G*GK. The matrix W9(LW2) is a diago- 
nal matrix containing the imaginary part of the stabilized eigenvalues. 

The partitioned matrix manipulations make it possible to perform 
complex arithmetic without using complex numbers. The constructed 
FM matrix has the stable adjusted eigenvalues and the same eigenvectors 
as F+G*GK 
2. USAGE 

a. Calling Sequences 

CALL PIFEIG (F, NF, FM, NFM, W9 , NW9DIM, DEBUG, IFREIG, ER, El, ERV, 

IEV, G, NG, ICH, GK, NGK) 

b. Input Arguments 

F, G, GK Matrices packed by columns into one-dimensional arrays; F 

and G are not destroyed upon return. If ICH (2,11) is FALSE, 

GK contains an initial starting gain and is not destroyed upon 
return. 

IE Integer vector of dimension at least NF(1). If the eigen- 

value adjustment procedure in PIFEIG is to be performed on 
th 

the i eigenvalue then IE(i) must be 1 . If IE(i) is 0, 

the i^ eigenvalue in FM equals the i^ eigenvalue of F+G*GK. 

If the i*”^ eigenvalue is complex and the i^+l eigenvalue is 
the complex conjugate, then IE(i) and IE(itfl) must contain 
the same integer number (lor 0). The order in IE must 
apriori agree with the order of the eigenvalues computed by 
FREEF. The IE feature is useful if a plant eigenvalue is 
stable but uncontrollable. If ICH(2,11) is TRUE, all elements in 
IE are automatically set to 1. 
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ER, EV 


IEV 


ERV 


W9 


ICH 


NF NG NGK 


DEBUG 


IFREIG 


Real work vectors of dimension at least NF(1). During compu- 
tation the adjusted real parts of the eigenvalues are. placed 

in ER and the imaginary parts of the eigenvalues -are. placed 
in EV. 

Integer vector of dimension at least NF(1). Each- of the 
locations must contain the integer 1. If ICH(2,11) is 
TRUE, all IEV elements are automatically set to 1. 

Real work matrix of dimension NF(1)*NF(1). ERV is not used 
by PIFEIG as long as IEV has all l's. 

Work matrix packed by columns into a one-dimensional array. 
Dimension must be at least I6*(NF(1)*NF(2)+1) 

Two-dimensional logical matrix dimensioned 10 x 15. Sub- 
routines in PIFCGT are called depending on the TRUE or FALSE 
status of elements in ICH. 

Two-dimensional integer vector holding the number of rows 
and columns of the matrix shown after the letter N. 

Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

The results of the construction of FM can be observed by 

setting this variable to 0, 1, or 2 

2- Compute and print eigenvalues and eigenvectors of FM 1 
1- Compute and print eigenvalues of FM 
0- No eigenvalue computations 
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c. Output Arguments 

FM Matrix packed by column into a one-dimensional array. FM 

contains the desired closed-loop PIF plant used in PIFPLC. 

NFM Two-dimensional integer vector holding the number of rows 

and columns of the matrix FM, NFM(1)=NF(1) , NFM(2)=NF(2) . 

d . COMMON Blocks 
None 

e. Error Messages 

If the W9 matrix is insufficiently large, the message "The W9 matrix 
is too small" is printed and the program stops. If DEBUG is TRUE, the 
following matrices are printed out during the course of the computation 
GKRA - the random or input GK gain matrix 
REAL - the real part of the eigenvalues of F+G*GK 
IMAG - the imaginary part of the eigenvalues of F+G*GK 
ETMA - the 2*NF(1) x 2*NF(1) matrix containing the part- 
itioned eigenvectors of F+G*GK 
ER - the adjusted real part of the eigenvalues of F+G*GK 
El - the adjusted imaginary parts of the eigenvalues of 
F+G*GK 

REAL - the real part of the eigenvalues to be placed in FM 
IMAG - the imaginary part of the eigenvalues to be placed 
in FM. 

EIMA - the 2*NF(1) x 2*NF(1) matrix containing the partition- 
ed adjusted eigenvalues of FM. 

IDEN - the inverse of ETMA is multiplied by ETMA and the 
result is printed out as the matrix IDEN. 


97 



The accuracy of the inversion can be determined by 
judging how close IDEN is to an identity matrix. 

TLTI - the 2*NF(1) x 2*NF(1) matrix obtained by multiplying 
ETMA*EIMA*ETMA. If the subroutine GELIM produces an 
error in inverting ETMA, the message "GELIM IN EIGP 
IERR = XXXX" is printed 

f. Subroutines Employed by PIFEIG 

ORACLS - NULL, EQUATE, MULT, ADD, GELIM, UNITY, SCALE, DETFAC , EIGEN 
PIFLIB - DIAGPAR , DIAGPUT, CORNER, FREEF, RESPON, SMALL, PRNT, PRNTITL 

g. Subroutines Employing PIFEIG > 

PIFGCT 

h. Concluding Remarks 

In all applications of PIFEIG by the program PIFCGT, the locations in 
IE and IEV are all set to 1. It is not necessary to use PIFEIG and 
PIFPLC if DSTAB in ASYMREG in DREG finds an initial stabilizing gain 
for the closed-loop plant. 
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z. 


PIF CLOSED-LOOP EIGENVALUE EIGENVECTOR CALCULATIONS (PIFFRE) 


1 . PURPOSE 

PIFFRE takes the matrix log of the closed-loop PIF system matrix, 

PHICL, then computes the eigenvalues and eigenvectors of the resulting 
matrix. 

2. USAGE 

a. Calling Sequences 

CALL PIFFRE (DELT, W9, DEBUG, NW9DIM, PHICL, NPHC, IFREEP , ICH, ELOG, 
MLOG) 

b. Input Arguments 

PHICL Matrix packed by columns into a one dimensional array; not 

destroyed upon return. 

NPHC Two-dimensional integer vector holding the number of rows 

and columns of the matrix PHICL. 

ELOG Real scalar convergence test for LOGXl. Recommend 1.0E-10. 

MLOG Integer scalar indicating the maximum number of iterations 

used in the LOGXl subroutine. Recommend 8. 

IFREEP Integer scalar used to determine eigenvalue eigenvector cal- 
culations 

=0 Do not perform calculations 
=1 Compute eigenvalues 

=2 Compute eigenvalues and eigenvectors 
W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 3* (NPHC (1) **2+1) 
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ICH 


Two-dimensional logical matrix dimensioned 10 x 15. 


Subroutines in PIFCGT are called depending on the TRUE or 
FALSE status of elements in ICH. 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

DELT Real scalar containing the sampling time 

NW9DIM Integer scalar containing the maximum dimension of the W9 
matrix. 

c. Output Arguments 
None 

d. COMMON Blocks 
None 

e. Error Messages 

If the W9 matrix is insufficiently large, the message "THE W9 WORK 
MATRIX IS TOO SMALL" is printed and the program stops. 

f. Subroutines Employed by PIFFRE 

ORACLS - EQUATE, EXPADE, MULT, NORMS, SCALE, SUBT, UNITY, EIGEN 
PIFLIB - L0GX1 , FREEF, RESPON 

g. Subroutines Employing PIFFRE 

PIFCGT 

h. Concluding Remarks 
None 
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AA. PIF GAIN COMPUTATIONS (PiFr.’t 


1 . PURPOSE 

Subroutine PIFG performs three functions: 

o The feedback gain, Riccati equation solution, and 

feedforward matrix solution are used to construct the 
matrices in the implementable PIF control law. 
o The body-axis aircraft states used for feedback are 

replaced with available measurements. Gain matrices in 
the implementable PIF control law are reconfigured to 
accommodate the measurements, 
o IF METERS is TRUE, the units in the PIF control law are 
changed from feet and degrees to meters and radians. 

Gain matrices in the implementable PIF control law are 
reconfigured to accommodate the change in units and 
printed out. The actual values of the PIF control law 
gains do not change units at the end of PIFG execution 
if METERS xs TRUE. Program execution proceeds as follows: 
The feedback gain, GK, is partitioned into three gain sets and 
they are extracted from GK. 

I I 

GK = [ K1 I K2 I K3 ] (1) 

I I 

The Riccati equation solution, X, is partitioned into nine individual 
matrices and three of them (PZZ, PUZT, PXZT) are extracted from X. 


PXX 

PXU 

PXZ 

PXUT 

PUU 

PUZ 

PXZT 

PUZT 

PZZ 


( 2 ) 
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The matrix A is computed 


A = PZZ 1 * (PUZT * S22 + PXZT * S12) 


(3) 


and used to construct S42 


S42 = K3 * A - K2 * S22 - K1 * S12 
The matrix HAC is computed 
HAC = -K2 * S21 


(4) 


(5) 


The new measurements, z, are related to the aircraft states by con- 
structing the T matrix. 



( 6 ) 


(7) 


The feedforward matrices are reconfigured to accommodate the new 
measurements 


'Sll 

S12' 

'HX 

DX - 


' Sll 

S12" 

_S21 

S22. 

. o 

I _ 


_ S21 

S22. 


new old 


( 8 ) 


The feedback gains K1 and K2 are reconfigured to accommodate the new 
measurements 


[K1 K2] = [K1 K2] 

new old 


HX DX 


-i—l 


L 0 IJ 


(9) 
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The PIF gains S31 and S41 are constructed 


S31 = I + DELT * K2 (10) 

S41 = DELT * K3 (11) 


The resulting implementable PIF structure has the following form 


^+1 ' + DELT * 2k + 521 - ^m,k ) 


Sk = 2k - S11 x 


^m,k 


Vfc - S31 v k _ x + BAC0^ >k - - e^) 


+ S41(Hx, . + Du. ,-Hx . ,-Du ,) + S42(u . , . 

— k-1 — k-1 nrm,k-l m-m,k — m,k+l 


( 12 ) 

(13) 


u 

— m 


,k> (14) 


The gain elements in the implementable PIF structure are modified if 
the METERS option is TRUE and printed out. The gain matrices at the 
end of the program execution remain in the units of feet and degrees. 

2 . USAGE 

a. Calling Sequence 

CALL PIFG (Sll, NS11, S12, NS12, S21, NS21, S22, NS22, GK, NGK, X, NX, 
S31, NS31 , S32 , NS32, HAC, NHAC, S41, NS41, S42, NS42, DELT, DEBUG, W9, 
NW9DIM, HX, DX, NHX, NDX, METERS, ICHOSE) 

b. Input Arguments 
Sll, S12, 

S21, S22, 

GK, X, 

HX, DX Matrices packed by columns into one-dimensional arrays; HX, 
DX, S21, and S22 are not destroyed upon return 
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NS11, NS12 


NS21, NS22, 

NGK, NX, 

NHX, NDX Two-dimensional integer vector holding the number of rows 
and columns of the matrix shown after the letter N. 

METERS Logical scalar indicating when units of the control law should 
be changed to meters and radians. 

ICHOSE Integer scalar which indicates which command system is being 
designed. 

W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 9*(NX(1)*NX(2)+1) . 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug inforamtion. 

DELT Real scalar containing the sampling time. 

NW9DIM Integer scalar containing the maximum dimension of the W9- 

matrix. 

c. Output Arguments 

Sll, S31, 

S32 , HAC, 

S41, S42, 

S21 Matrices packed by columns into one-dimensional arrays 

constituting the PIF control law feedback and feedforward 
gains. 

NS11, NS31, 

NS32, NHAC, 

NS41, NS42, 

NS21 Two-dimensional integer vector holding the number of rows 
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and columns of the matrix shown after the letter N. 


d. COMMON blocks 
None 

e. Error Messages and Printout 

If the W9 matrix is insufficiently large the message "THE W9 WORK 
MATRIX IS TOO SMALL" is printed and the program stops. If the value 
m ICHOSE is not a recognized command system then the following is 
printed "IN PIFG WITH METERS TRUE, ICHOSE = XXX IS NOT A KNOWN COMMAND 
MODE. CHANGE PIFG TO ACCOMMODATE ICHOSE VALUE." IF DEBUG is TRUE, the 
following matrices are printed during the course of program execution: 
Kl, K2, K3, PZZ, PZZ -1 (PZ-1), PUZT, PXZT, A, T, T _1 (T-1) 

SUB - The Sll feedforward matrix before the new measurements are 
accommodated. 

S12B - The S12 feedforward matrix before the new measurements are 
accommodated. 

The following are always printed out: 

Before changing units 

Sll, S12 , S21 , S22 , S31, S32, S41, S42, HAC 
After changing units if METERS is TRUE 
S31M, S21M, HACM, S32M, SUM, S41M, S42M 

f. Subroutines Employed by PIFG 

ORACLS - MULT, ADD, SUBT, SCALE, UNITY, GELIM, JUXTC, EQUATE, DETFAC 
PIFLIB - DIAGPAR, CORNER, PRNT, PRNTITL 

g. Subroutines Employing PIFG 
PIFLIB - PIFCGT 

h. Concluding Remarks 

The derivation used to obtain Eqs. 3 to 14 is shown in Chapter III 
of Ref. 1. 
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BB. CONSTRUCT THE PIF MODELS (PIFMODL) 


1 . PURPOSE 

The purpose of PIFMODL is to construct the following matrices 


PHI 


F G 0 
0 0 0 
_H D 0. 


( 1 ) 


GAMA 



( 2 ) 


QHAT 


A AM 0 

AMT R 0 

_ 0 0 QZ. 


(3) 


RHAT 

= RD 

(4) 

HX = 

I 

(5) 

DX = 

0 

(6) 


HX and DX are NF(1) and NF(1) x NG(2) aircraft observation matrices. 
The order of the states is Au Aw.Aq A0 Az Ax Av Ar Ap A(f> Ai}» Ay. If 
ICH(2,10) is TRUE, Au observation in HX and DX is replaced with Aa x 
observation. If ICH(2,9) is TRUE, Av observation in HX and.DX is 
replaced with Aa^ observation. If ICH(2,10) is TRUE, Aw observation 
in HX and DX is replaced with Aa z observation. Variables in XL 
are changed depending on whether or not METERS, ICH(2,8) ,ICH(2,9) 
and ICH(2 , 10) ' are TRUE. 
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2 . 


USAGE 


a. Calling Sequences 

CALL PIFMODL(F, NF, G, NG, H, NH, D, ND, PHI, NPH, GAMA, NGA, Q, NQ, 

R, NR, AM, NAM, QZ, NQZ, QHAT, NQH, RD, NRD, RHAT, NRH, ZERO, NZERO , 

HX, NHX, DX, NDX, HAC, NHAC, DAC, NDAC, W9, NW9DIM, DEBUG, METERS, 

ICH, XL, UL, YL) 

b. Input Arguments 
F, G, 

H, D, 

Q, AM, 

R, QZ, 

RD Matrices packed by columns into one-dimensional arrays; not 

destroyed upon return. 

HAC, DAC Matrices packed by columns into one-dimensional arrays; not 
destroyed upon return. These are the observation matrices 

for the body mounted accelerometers computed in HADAC. 

XL, UL, YL Two dimensional arrays containing plotting labels for the 
states, controls, and commanded outputs, respectively. 

NF, NG, NH, 

ND, NQ, NR, 

NAM, NQZ, 

NZERO, NHAC, 

NDAC Two-dimensional integer vector holding the number of rows 

and columns of the matrix shown after the letter N. 

W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 2 x{(NF(l) + NG(2) + NH(l))**2+l} 
Work matrix packed by columns into a one-dimensional array. 


ZERO 
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All. elements must be 0.0. Dimensions must be at least 


NPH(l) * NPH(2)+1 

ICH Two-dimensional logical matrix dimensioned 10 x 15. . Sub- 

routines in PIFCGT are called depending on the TRUE' or FALSE 
status offelements in ICH. 

DEBUG Logical scalarr indicating the following:' 

TRUE:* Print' out debug information > 

FALSE: Do not' print- out. debug information- 

NW9DIM Integer- scalar 'containing the maximum dimension of the W9 
matrix. 

c. Output Arguments 

QHAT, RHAT, 

HX, DX, 

PHI, GAMA Matrices -packed by columns into one dimensional J arrays'. 

NQH, NRH, 

NPH, NGA Two dimensional 1 integer vectors holding the- number of rows 
and"columns of the matrix shbwn after the letter N. 

XL Two dimensional array containing labels to be used' in -plot- 

ting; .some are-changed upon return depending on logical- 
parameters -METERS and ICH. 

d. COMMON’ Blocks ~ 

None 

e. Error Messages - 

If the W9 matrix- is- insufficiently large the message "THE W9 -WORK 

MATRIX IS TOO SMALL" is printed and the program stops. If DEBUG is 

true then- the following is printed out during program execution: 
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PHI, GAMA, QHAT, RHAT, HX, DX 

f. Subroutines Employed by PIFMODL 
ORACLS - JUXTC, UNITY, JUXTR, TRANP, EQUATE 
PIFLIB - DIAGPAR, CORNER, PRNT, PRNTITL 

g. Subroutines employing PIFMODL 
PIFCGT 

h. Concluding Remarks 

The perturbation relationship between the body mounted accelerometer 
outputs, Aa^ Aa^ and Aa z , and the aircraft body-axis states is derived 
in Ref. 1, Appendix B. 
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CC. PIF EIGENVALUE PLACEMENT (PIFPLC) 


1 . PURPOSE 

In Ref. 6 a technique is given for computing a feedback gain which 
places eigenvalues and eigenvectors of a plant to those dictated by 
an ideal model. The purpose of PIFPLC is to compute a stabilizing 
feedback gain for the PIF control law using the eigenvalue eigenvector 
placement procedure in Ref. 6. The ideal model (PHICL) is computed in 
PIFEIG. The subroutine is only applicable to PIF model matrices. The 
subroutine first extracts the H matrix from the discrete PIF model 
matrix PHI. The discrete feedforward matrix equation 


PHI 

GAMA" 


"Sll" 


"Sll PHICL" 

_ H 

0 . 


_S21 _ 


H 


is solved for Sll and S21 using CGTPIF. The stabilizing feedback 
gain is computed as 

GK = S21 Sll _1 (2) 

2. USAGE 

a. Calling Sequence 

CALL PIFPLC (PHI, NPH, NH, GAMA, NGA, W9, NW9DIM, X, PHICL, NPHC, 

ACL, GK, NGK, DEBUG, ELOG, MLOG, ICH, DELT, NS11, NS12, NS21 , NS31 
NS32 , NS41, NS42, ICGT, TOL, ITER, ECGT) 

b. Input Arguments 

PHI, GAMA, 

PHICL Matrices packed by columns into one-dimensional arrays; 
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not destroyed upon return. PHI contains the discrete PIF 


NS1 1 , NS12 
NS21 , NS22 
NS31 , NS32 
NS41 , NS42 
ELOG 
X, ACL 
W9 

ICH 

NH, NPH, 
NGA, NPHC 

TOL 

ITER 

ECGT 


system matrix, GAMA contains the discrete PIF control effect 
matrix, and PHICL contains the desired closed-loop plant 
matrix (FM in PIFEIG) 


Two dimensional work integer vectors. 

Real scalar convergence test for L0GX1 subroutine. 

Work matrices of dimension at least NPH(l) * NPH (2) + 1 
Work matrix packed by columns into a one-dimensional array. 
Dimension must be at least 9* (NPH (1) **2+1) + 4 *((NPH(1) + 
NGA(2) + 2)**2+l) + 2* ( (NPH(l) + NGH(2) + 1)**2+1) 
Two-dimensional logical matrix dimensioned 10 x 15. Sub- 
routines in PIFCGT are called depending on the TRUE or 
FALSE status of elements in ICH. 

Two-dimensional integer vector holding the number of rows 
and columns of the matrix shown after the letter N. 

Real scalar indicating convergence criteria for iterative 
refinement in SOLVER. Recommend 1.0E-10 

Integer scalar indicating maximum number of interative re- 
finements in SOLVER. Recommend 10. 

Real scalar indicating convergence criteria in SOLVER for 
inverting a matrix. Recommend 1.0E-10 


ICGT 


Five dimensional integer option vector defined in CGTPIF. 



ICGT(l) is set to 2, ICGT(4) is set to 0 and ICGT(5) 
is set to 0 automatically by the subroutine before 
calling PIFCGT. The orginial values of ICGT are 
restored at the end of subroutine execution. 

DEBUG Logical scalar - indicating the following 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

DELT Real scalar containing the sampling time. 

NW9DIM Integer scalar containing the maximum dimension of the W9 
matrix. 

c. Output Arguments 

GK Matrix packed by columns into a one-dimensional array con- 

taining the stabilizing feedback gain. 

NGK Two dimensional integer vector holding the number of rows 

and columns of the GK matrix. 

d. COMMON Blocks 
None 

e. Error Messages 

If the W9 matrix is insufficiently large the message "THE W9 MATRIX 
IS TOO SMALL" is printed and the program stops. If the subroutine 
GELIM produces an error in inverting Sll, the message "GELIM ERROR 
IN PIFPLC IERR = XX" is printed. If DEBUG is TRUE then the following 
is printed out during the course of program execuation: 

HDO - The H matrix extracted from the PIF model matrix PHI. 
Matrices from -the execution of CGTPIF (see CGTPIF document). 

S11G - The Sll feedforward matrix solution of the feedforward 
matrix equation. 
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S21G - The S21 feedforward matrix solution of the feedforward 


matrix equation. 

- Sll is multiplied times S 1 1 ^ and the results, which 
should be an identity matrix, is printed out. 

The equvalent continuous-time closed-loop eigenvalues and 
eigenvectors of PHI + GAMA * GK. 

f. Subroutines Employed by PIFPLC 

ORACLS - NULL, EQUATE, UNITY, GELIM, MULT, ADD, DETFAC , SCALE, SUBT, 
NORMS, BCKMLT , HSHLDR, SCHUR, SYSSLV, EXPADE, EIGEN 
PIFLIB - PRNT, PRNTITL, EXTR, FREEF, RESPON, L0GX1, CGTPIF, AXBMXC, 
SHRSOL 

g. Subroutines Employing PIFPLC 
PIFLIB - PIFCGT 

h. Concluding Remarks 

It is not necessary to use PIFEIG and PIFPLC if DSTAB in ASYMREG in 
DREG finds an initial stabilizing gain. 



DP. OUTPUT NUMERICAL DATA (PRNT) 


1. PURPOSE 

Subroutine PRNT prints a single matrix with a descriptive heading on the 
same page. The descriptive heading is printed before each matrix and 
is of the form "NAM MATRIX NC(1) ROWS NA(2) COLUMNS." The matrix is 
printed by rows for seven columns at a time using the format, (I4,1P7E16.7) , 
where the first number is an integer depicting the row number. A heading of 
integers corresponding to the column number is printed above the matrix. 

2. USAGE 

a. Calling Sequence 
CALL PRNT (A,NA,NAM,-IOP) 

b. Input Arguments 

A Matrix packed by columns in a one-dimension array 

NA Two-dimensional vector giving the number of rows and columns of 

the matrix A: 

NA(1) = Number of rows of A' 

NA(2) = Number of columns of A 

NAM Hollerith characters giving matrix name. Generally NAM should 

contain 4 .Hollerith characters and be written in the argument list 
as 4HXXXX .' 

IOP Scalar print control parameter 

1. print heading and matrix on same page 

2. print heading and matrix on next page 

c. Output Arguments 
None 

d. COMMON Blocks 
None 
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e. Error Messages 

If NA(1) < 1 or NA(2) < 1 the message "PROBLEM WITH NUMBER OF ROWS OR 

NUMBER OF COLUMNS NA(1) = , NA(2) = " is printed, 

and the program is returned to the calling point. 

f. Subroutine Employed by PRNT 
None 

g. PIFLIB subroutines Employing PRNT 

PIFCGT, CGTPIF, HDCON , CFWM, PIFMODL, PIFPLC, REMAT, DISCMOD, QRMP1, 
QRMHAT, DREG, PIFG, DPIFS, FGAERO , HADAC, PIFEIG 

h. Concluding Remarks 


None 



EE. PRINT TITLE (PRNTITL) 

r i 

1. PURPOSE ■' 

Subroutine PRNTITL is used to print the name of a subroutine at the 
beginning and end of each pass through the subroutine. 

2. USAGE 

a. Calling Sequence 
CALL PRNTITL (NAMl, NAM2) 

b. Input Arguments 

NAMl Hollerith characters for 

ten Hollerith characters 
the form 10HXXXXXXXXXX . 

NAM2 Hollerith characters for 

ten Hollerith characters 
the form 10HXXXXXXXXXX. 

c. Output Arguments 
None 

d . COMMON Blocks 
None 

e. Error Messages 
None 

f. Subroutines Employed by PRNTITL 
None 


title to be printed out. The first 
in the title are placed in NAMl in 

title to be printed out. The second 
in the title are placed in NAM2 in 
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g. PIFLIB subroutines Employing PRNTITL 

DIMSS, HDCON , CFWM, PIFMODL, PIFPLC, REMAT, DISCMOD, QRMP1, QRMHAT, 
DREG, PIFG , DPIFS, FGAERO , HADAC, PIFEIG, RUNINFO, INTERP, PIFFRE 

h. Concluding Remarks 


None 



FF. OUTPUT LABELED NUMERICAL DATA (PRNT2) 


1. PURPOSE 

Subroutine PRNT2 prints out one matrix in columns of seven with labels 
or numbers, or it prints out two matrices in columns of seven with 
labels for comparison. PRNT2 also has the option of printing a third 
one dimensional array as a counter instead of row numbers. 

2 . USAGE 

a. Calling Sequence 

CALL PRNT2 (A, NA, NAM, B, NB, NAMB, IOP, C, LABEL, LABEL 1 , LABEL2 , M) 

b . Input Arguments 

A Matrix packed by columns into a one-dimensional array. 

A is the first matrix to be printed. 

B. Matrix packed by columns into a one-dimensional array. 

B is the second matrix to be printed. 

NA Two-dimensional vector giving the number of rows and columns 

of matrix A. 

NB Two-dimensional vector giving the number of rows and columns 

of matrix B. 

NA(1) - number of rows of A 
NA(2) - number of columns of A 
NB(1) - number of rows of B = NA(1) 

NB(2) - number of rows of B = NA(2) 

NAM Hollerith characters giving matrix A's name. Generally NAM 

should contain 4 Hollerith characters and be written in the 
argument list as 4HXXXX. 
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NAMB This is the name of the matrix B and follows the same rules 

as NAM. 

IOP Scalar print control parameter. 

IOP = 0 PRINT ONE MATRIX WITH LABELS - SAME PAGE 

IOP = 1 PRINT ONE MATRIX WITH LABELS - NEW PAGE 

IOP = 2 PRINT ONE MATRIX WITH NUMBERS - SAME PAGE 

IOP = 3 PRINT ONE MATRIX WITH NUMBERS - NEW PAGE 

IOP = 4 PRINT TWO MATRICES WITH LABELS - SAME PAGE 

IOP = 5 PRINT TWO MATRICES WITH LABELS - NEW PAGE 

C One-dimensional counter array; dimension = NA(1) 

LABEL LABELS for Array A, dimensioned (M,2) 

LABEL1 LABELS for Array B, dimensioned (M,2) 

LABEL2 LABELS for Array C, dimensioned (1,2) 

M First Dimension of LABEL array = NA(2) 

c. Output Arguments 
None 

d. COMMON Blocks 
None 

e. Error Messages 

If NA(1) < 1 or NA(2) < 1 the message "PROBLEM WITH THE NUMBER OF ROWS 

OR NUMBER OF COLUMNS NA(1) = , NA(2) = " is printed, and 

the program is returned to the calling point. 

f. Subroutines Employed by PRNT2 
None 

g. Subroutines Employing PRNT2 
PIFLIB - DPIFS 
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h. Concluding Remarks 


For printing one matrix - B, NB, NAMB and LABEL1 are dummy arguments, 
but they must be in the call to PRNT2. For printing without labels - 
C, LABEL, LABEL1, and LABEL2 are dummy arguments, but they must be in 
the call to PRNT2. 
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GG. SAMPLED-DATA REGULATOR USING ALPHA AND BETA (QRMHAT) 


1 . PURPOSE 

The purpose of QRMHAT is to compute the sampled-data regulator corres- 
ponding to a linear time-invariant continuous system and its associated 
linear quadratic cost function 

k = Fx + Gli (1) 

J = / x F Qx + u^ Ru dt (2) 

r-i — — — — 


The control, u, is assumed to be constant over the sampling interval 
At. The discrete plant and cost function are given by 

x k+1 = PHI x k + GAMA u k (3) 

co T T T 

J = k E Q (x k QHAT x k + 2x k AMHAT + u^ RHAT u^) (4) 

The matrices in the sampled-data regulator problem are computed 
using the following equations 


PHI = f (FAt) k = e FAt 
U k! 

GAMA = / At ? (Ft ) k dT = / At e FT dt 
o k=0 r~r o 

k! 

QHAT = / At e pTT Qe FT dx 

AMHAT = |^/ At e^ 1 Q(/ X e Fs ds)dxjG 

RHAT = At R + G T j^ At (^ T eAlS ds)Q (/ T e As ds)dx J G 


(5) 

( 6 ) 

(7) 

( 8 ) 
(9) 
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QHAT is computed using the ORACLS subroutine SAMPL. PHI and GAMA are 
computed using the ORACLS subroutine EXPINT. AMHAT and RHAT are com- 
puted using the subroutine ALPHA. If ICH(2,7) is TRUE, a matrix similar 
to PHI is computed using the matrix PHICL and the ORACLS subroutine EXPSER. 
The continuous time model for "F" used in computing PHICL is determined 
in the subroutine PIFEIG as the matrix FM. The last part of QRMHAT is 
specially adapted to PIF controller computation. For PIF, F and G in 
the calling program have the following internal form 


F = 


A 

0 

H 


B 

0 

D 


0 

0 

0. 



( 10 ) 


( 11 ) 


After PHI and GAMA are computed using EXPINT, they are altered from 


PHI = 


GAMA = 



GAMAg 

I 


0 

0 

I 


to 


PHI = 


'PHI A GAMA b 0 
0 10 
AtH AtD I 


GAMA = 


0 

Atl 
_ 0 


( 12 ) 

(13) 


(14) 


(15) 
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2 . 


USAGE 


a. Calling Sequence 

CALL QRMHAT (H, NH, QHAT, NQH, D, ND, RHAT, NRH, AMHAT, NAM, PHI, NPH, 
GAMA, NGA, DELT, ICH, DEBUG, W9, NW9DIM, ZERO, NZERO , PHICL, NPHC) 

b. Input Arguments 
H, QHAT, 

D, RHAT, 

PHI, GAMA, 

PHICL Matrices packed by columns in one-dimensional arrays. H and D 

are not destroyed upon return. The rest are destroyed upon 
return. Using the notation in the PURPOSE section, QHAT 
contains Q, RHAT contains R, PHI contains F, GAMA contains 
G, and PHICL contains the desired continuous-time closed- 
loop system (FM) constructed in PIFEIG. 

W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 14* (NPH(l) * NPH(2) +1) 

ZERO Work matrix packed by columns into a one-dimensional array. 

All elements must be zero. Dimension must be at least 
NPH(l) * NPH(2) + 1 

ICH Two-dimensional logical matrix dimensioned 10 x 15. Sub- 

routines in PIFCGT are called depending on the TRUE or FALSE 
status of elements in ICH. 

NH, NQH, 

ND, NRH, 

NAM, NPH, 

NGA, NZERO, 

NPHC Two-dimensional integer vector holding the number of rows and 
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columns of the matrix shown after the letter N. NZERO 


is the only vector destroyed upon return. 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

DELT Real scalar containing the sampling time. 

NW9DIM Integer scalar containing the maximum dimension of the W9 
matrix. 

c. Output Arguments 

QHAT, RHAT, 

AMHAT, PHI, 

GAMA, PHICL Matrices packed by columns into one dimensional arrays 
containing the discrete plant representation shown in the 
PURPOSE section. 

d. COMMON Block 

None 

e. Error Messages 

If the W9 matrix is insufficiently large the message "THE W9MATRIX IS 
TOO SMALL" is printed and the program stops. If ICH(4,2) and ICH(4,3) 
are both true the message "BOTH ICH(4,2) AND ICH(4,3) ARE TRUE CONFLICT 
IN CALCULATIONS OF GAMA, PHI, QHAT, RHAT, AND AMHAT" is printed and the 
program stops. If DEBUG is true the print option in ORACLS subroutines 
SAMPL and EXPINT are activated and the following matrices at the end 
of subroutine execution are printed: PHI, GAMA, QHAT, RHAT, AMHAT, 

(AMHA) , PHICL (PHCQ) . 
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f. Subroutines Employed by QRMHAT 

ORACLS - EQUATE, SAMPL, EXPINT, MULT, EXPSER, TRANP , SCALE, ADD, UNITY, 
JUXTC, JUXTR 

PIFLIB - PRNTITL, PRNT, CORNER, ALPHA, BETA 

g. Subroutines Employing QRMHAT 
PIFCGT 

h. Concluding Remarks 

ORACLS software has a problem when computing the sampled data regulator 
representation when NGA(2) = 1. QRMHAT serves as backup software to 
QRMPl when the latter fails. 
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HH. SAMPLED-DATA REGULATOR USING ORACLS (QRMP1) 


1 . PURPOSE 

The purpose of QRMP1 is to compute the sampled-data regulator corres- 
ponding to a linear time-invariant continuous system and its associated 
linear quadratic cost function. 


x = Fx + Gu (1) 

J = / x F Qx + u^ Ru dt (2) 

o — — — 


The control, u, is assumed to be constant over the sampling interval, 
At. The discrete plant and cost function are given by 


x = PHI x, + GAMA u, 
k+1 — k — k 


(3) 


J = 



(£ QHAT + 2xJ AMHAT u, + n T RHAT u, ) 
k — k — k — k — k -=k 


(4) 


The matrices in the sampled-data regulator problem are computed using 
the following equations 


PHI 


f (FAt) k 
k=0 k! 


FAt 

e 


GAMA 


f At (Fx) k 
o k=0 k! 


dx 



Fx 

e 


dx 


QHAT = / At e FlT Qe FT dx 

AMHAT = jV At e^ Q(/ X e Fs ds)dx]c 

RHAT = At R + G T [/ At f (/ X e ATs ds)Q(/ X e As ds)dxlc 
o L o o J 


(5) 

( 6 ) 

(7) 

( 8 ) 

(9) 
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QHAT, RHAT AND AMHAT are computed using the ORACLS subroutine SAMPL. 

PHI and GAMA are computed using the ORACLS subroutine EXPINT. If 
ICH(2,7) is TRUE a matrix similiar to PHI is computed using the matrix 
PHICL and the ORACLS subroutine EXPSER. The continuous time model for 
"F" used in computing PHICL is determined in the subroutine PIFEIG as 
the matrix FM. The last part of QRMP1 is specially adapted to PIF con- 
troller computation. For PIF, F and G in the calling program have the 
following form: 


'A B 
F = 0 0 

H D 



( 10 ) 


G = 


0 

I 

0 


After PHI and GAMA are computed they are altered from 


PHI 


PHI A GAMAg 0 1 

0 I 0 


GAMA 


r x 3 

At I 


to 


PHI = 


GAMA = 



GAMA B 0 
I 0 

AtD I . 


(ID 


( 12 ) 


(13) 


(14) 


(15) 
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The alteration implies the particular digital implementation used in 

the PIF control law as described in Ref. 1, Chapter III. 

2 . USAGE . 

a. Calling Sequence 

CALL QRMPl (H, NH, QHAT, NQH, D, ND, RHAT, NRH, AMHAT, NAM, PHI, NPH, 

GAMA, NGA, DELT, ICH, DEBUG, W9, NW9DIM, ZERO, NZERO, PHICL, NPHC) 

b. Input Arguments 

H, QHAT, 

D, RHAT, 

PHI, GAMA, 

PHICL Matrices packed by columns in one-dimensional arrays. H and 

D are not destroyed upon return. The rest are destroyed 
upon return. Using the notation in the PURPOSE section, 

QHAT contains Q, RHAT contains R, PHI contains F, GAMA con- 
tains G and PHICL contains the desired continuous-time 
closed-loop system (FM) constructed in PIFEIG. 

W9 Work matrix packed by columns into a one-dimensional array. 

Dimension must be at least 14 * (NPH(l) * NPH(2) +1) 

ZERO Work matrix packed by columns into a one-dimensional array. 

All elements must be zero. Dimension must be at least 
NPH(l) * NPH (2) + 1 

ICH Two-dimensional logical matrix dimensioned 10 x 15. Sub- 

routines in PIFCGT are called depending on the TRUE or FALSE 
status of elements in ICH. 
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NH, NQH, ND 


NRH, NAM, 

NPH, NGA, 

NZERO, NPHC, Two-dimensional integer vector holding the number of rows 
and columns of the matrix shown after the letter N. NZERO 
is the only vector destroyed upon return. 

Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

Real scalar containing the sampling time. 

Integer scalar containing the maximum dimension of the W9 
matrix. 

c. Output Arguments 

QHAT, RHAT, 

AMHAT, PHI, 

GAMA, PHICL Matrices packed by columns into one dimensional arrays 
containing the discrete plant representation shown in the 
PURPOSE section. 

d. COMMON Blocks 

None 

e. Error Messages 

If the W9 matrix is insufficiently large the message "THE W9 MATRIX IS 
TOO SMALL" is printed and the program stops. If DEBUG is true the 
following matrices at the end of subroutine execution are printed: PHI, 

GAMA, QHAT, RHAT, AMHAT (AMHA) , PHICL (PHCQ) 


DEBUG 

DELT 

NW9DIM 
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f. Subroutines Employed by QRMP1 

ORACLS - EQUATE, SAMPL, EXPINT, MULT, EXPSER, TRANP , SCALE, ADD, 
UNITY, JUXTC, JUXTR 
PIFLIB - PRNTITL, PRNT, CORNER 

g. Subroutines Employing QRMP1 

PIFLIB - PIFCGT 

h. Concluding Remarks 

ORACLS subroutine SAMPL has a problem when computing the sampled data 
regulator representation when NGA(2) = 1. QRMHAT serves as back up 
software to QRMP1 when the later fails. 
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II, REDUCE MATRICES (REMAT) 


1. PURPOSE 

The purpose of REMAT is to eliminate rows and columns of matrices, and 
reduce the matrix dimensions. The information used by REMAT to eliminate 
rows and columns is given in the logical vectors XR, UR, YR, XMR, and 
UMR. The values in the logical vectors are specified in the subroutine 
HDCON. If a logical variable entry is TRUE, the corresponding state or 
control or command is to be retained in the PIF design problem. If a 
logical variable entry is FALSE, the corresponding state or control or 
command is to be eliminated. The correspondance between logical vector 
elements and variables is as follows: 


Au 

XR(1) 

Aw 

XR(2) 

Aq 

XR(3) 

A6 

XR(4) 

Az Ax Av 

XR(5) XR(6) XR(7) 


Ar 

XR(8) 

Ap 

XR(9) 

A<j> 

XR(10) 

Alp Ay 

XR(ll) XR(12) 

Afiip 

UR(1) 

A6 e 

UR(2) 

A6 a 

UR(3) 

A6 r 

UR(4) 


YL0N1 

YR(1) 

YL0N2 

YR(2) 

YLAT1 

YR(3) 

YLAT2 

YR(4) 


XMi 

XMR(l) 

xm 2 

XMR (2) 

xm 3 

XMR(3) . . 

. XMR(NM) 

UM X 

UMR(l) 

um 2 

UMR(2) 

um 3 

UMR (3) . . 

UMmm 

. UMR (MM) 
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XR is used to eliminate rows in the following matrices: F, G, Q, AM, 

PHI, QHAT, GAMA, XL, HX, HAB 

XR is used to eliminate columns in the following matrices: F, Q, H, 

PHI, QHAT, HX, DX 

UR is used to eliminate rows in the following matrices: UL, R, RD, 

RHAT, PHI, GAMA, QHAT 

UR is used to eliminate columns in the following matrices: G, D, R, 

AM, RD, RHAT, GAMA, PHI, QHAT 

UR is used to eliminate rows in the following matrices: YL, H, D, 

QZ, HM, DM, PHI, GAMA, QHAT 

YR is used to eliminate columns in the following matrices: QZ, PHI, 

QHAT 

XMR is used to eliminate rows in the following matrices: FM, GM 

XMR is used to eliminate columns in the following matrices: FM, HM 

UMR is used to eliminate columns in the following matrices: GM, DM 

2. USAGE 

a. Calling Sequence 

CALL REMAT (N, M, L, NM, MM, DEBUG) 

b. Input Arguments 

N, M, L, 

NM, MM Real scalars indicating matrix dimensions before reduction; 
changed upon return 

DEBUG Logical scalar indicating the following: 

TRUE: Print out debug information 

FALSE: Do not print out debug information 

c. Output Arguments 
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N, M, L, 


NM, MM Real scalars indicating matrix dimensions after reduction. 

d. COMMON Blocks 

DISCSV, W0RKS9, WGHTS, MODF, DISCM, PLA, DIMN1, DIMN2 , DIMN3 , DIMN4 , 
EIGEN, LABEL 

e. Error Messages and Printout 

If DEBUG is TRUE then following sequence of matrices are printed out 
after they have been reduced: F, HX, HAB, Q, G, DX, R, AM, RD, H, 

T> y QZ, FM, HM, GM, DM, PHI, QHAT, GAMA, RHAT 

f. Subroutines Employed by REMAT 
ORACLS - EQUATE 

PIFLIB - PRNT, PRNTITL, MOVEALL 

g. Subroutines Employing REMAT 
PIFCGT 

h. Concluding Remarks 
None 
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JJ. STEP RESPONSE EIGENVALUE INFORMATION (RESPON) 


1 . PURPOSE 

RESPON in association with FREEF and FREEO computes step response in- 
formation for a given eigenvalue. 

2. USAGE 

a. Calling Sequence 

CALL RESPON (RR, RI, FREQNA, DAMRAT, THALF, PERIOD, TAU, T90, T98, 
T100, OVERSH) 

b. Input Arguments 

RR Real part of an eigenvalue 

RI Imaginary part of an eigenvalue 

c. Output Arguments 

FREQNA Natural frequency 

DAMRAT Damping ratio 

THALF Time to reach 50% of a step command 

PERIOD Time for a complex eigenvalue to complete one oscillation 
TAU Time constant 

T90 Time to reach 90% of a step command 

T98 Time to reach 98% of a step command 

T100 Time for the step response of a complex eigenvalue to 

cross the step command the first time. 

OVERSH xhe overshoot of a stable complex eigenvalue in response to 

a step input. 

d. COMMON Blocks 
None 
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e. 


Error Messages 


None 

f. Subroutines Employed by RESPON 
None 


g. Subroutines Employing RESPON 
PIFLIB - FREEF, FREEO 

h. Concluding Remarks 


None 



KK. PRINT OUT INFORMATION (RUNINFO) 


1 . PURPOSE 

Subroutine RUNINFO prints out the values of all variables used in the 
PIF design. RUNINFO contains a listing of all available subroutine 
calls and a listing of all variables used by the PIF program along 
with their definitions. 

2. USAGE 

a. Calling Sequence 
CALL RUNINFO (NUM) 

b. Input Arguments 

NUM Directs RUNINFO to print out one of two kinds of information 

=1 Print out subroutine call information 
=2 Print out variable input information 

c. Output Arguments 
None 

d. COMMON Blocks 

WORKS 9 , RNINFO , RNINFOl, RNINF02, QWHT, EIGEN, LABLE, UDIR, GLAD, DEBG, 
AERO, EIGS, HDXA 

e. Error Messages 
None 

f. Subroutines Employed by RUNINFO 
None 

g. Subroutines Employing RUNINFO 
PIFLIB - PIFCGT 

h. Concluding Remarks 
None 
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LL. CREATE A (3XN) MATRIX FROM 3 DIFFERENT 1XN MATRICES (R3MAT) 


1 . PURPOSE 


Three row vectors A, B and C are scaled by SCI, SC2, and SC3, respect- 
ively. The three row vectors are grouped into the matrix D, 


D = 



( 1 ) 


The matrix D is scaled by the scalar S. 


2. USAGE 


a. Calling Sequence 

CALL R3MAT (A, B, C, D, ND, NW1 , SCI, SC2 , SC3 , S, W9) 


b. Input Arguments 

A, B, C One dimensional vectors 

NW1 Two dimensional integer vector containing the number of rows 

and columns of A, B and C: 

NW1(1) = 1 
NW1(2) = N 


SCI, SC2, 

SC3 Scale factors for A, B and C, respectively 

S Scale factor for the matrix D after creation 

W9 Work space 

c. Output Arguments 

D A 3 x N matrix packed by columns into a one-dimensional array 

with rows of A, B and C, respectively. 

ND Number of rows and columns of D 

ND(1) = Number of rows of D 


ND(2) = Number of columns of D 



d. 


COMMON ' Blocks 


None 


e. Error Messages 


None 

f . Subroutines 1 Employed by R3MAT 
ORACLS - JUXTR, SCALE 

g. Subroutines Employing R3MAT 

PIFLIB - FGAERO 

h. Concluding Remarks 


None 
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MM. SCHUR FORM SOLUTION OF A * X * B - X = C (SHRSOL) 


1. PURPOSE 

Subroutine SHRSOL solves the algebraic matrix equation 
A*X*B - X = C 

where it is assumed that the matrix A is in lower real SCHUR form 

and the matrix B is in upper real SCHUR form. Subroutine SYSSLV is 

used in SHRSOL to solve a system of order 2 or A by Crout elimination. 

Common block SLVBLK is used to communicate with SYSSLV. 

2 . USAGE 

a. Calling Sequence 

CALL SHRSOL (A,B,C,N,M,NA,NB,NC) 

b . Input Arguments 

A, B,C Matrices stored in two-dimensional array. First dimensions 
are NA, NB and NC, respectively. Second dimensions are at 
least N, M, and N. Matrix C is destroyed upon return. 

N Order of the matrix A. 

M Order of the matrix B. 

NA,NB, 

NC Maximum first dimensions of the matrices A, B, and C, resp- 

ectively, as given in the DIMENSION statement of the calling 
program. 

c. Output Arguments 



c 


Two-dimensional array containing the solution, X. 


d. COMMON Blocks 
SLVBLK 

e. Error Messages 

If the subroutine fails to find a solution the message "AIUORITHM 
FAILED TO PRODUCE SOLUTION" is printed and the program terminates 
execution. 

f. Subroutines Employed by SHRSOL 
ORACLS - SYSSLV 

g. PIFLIB subroutines Employing SHRSOL 
AXBMXC 

h. Concluding Remarks 

It is recommended that the program SOLVER which calls AXBMXC which 
subsequently calls SHRSOL be used to solve Eq. 1. This subroutine 
is a generalization of algorithms reported in Ref. 3. 
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NN. ROUND OFF SMALL NUMBERS (SMALL) 


1. PURPOSE 

To zero out elements in a matrix with very small values. 

2. USAGE 

a. Calling Sequence 
CALL SMALL (A , NA) 

b. Input Arguments 

A Input matrix packed by columns in a one dimensional array. 

NA Two-dimensional vector contains number of rows and columns in A 

NA(1) = number of rows in A 
NA(2) =■ number of columns in A 

c. Output Arguments 

— Q 

A If | A (i , j ) | < 1 x 10 then A(i,j) = 0. No action otherwise. 

NA No change 

d. Common Blocks 
None 

e. Error Messages 
None 

f. Subroutines employed by SMALL 
None 

g. Subroutines employing SMALL 

PIFLIB - PIFEIG 

h. Concluding Remarks 

Helps in interpreting output if very small elements are zero. 



00. ITERATIVE REFINEMENT SOLUTION OFA*X*B-X=C (SOLVER) 


1. PURPOSE 

Subroutine SOLVER solves the algebraic matrix equation 

A*X*B - X = C (1) 

for the matrix X using the program AXBMXC. SOLVER is primarily used 
to determine a highly accurate solution to Eq. 1 using iterative re- 
finement. After AXBMXC computes the first solution to (1), the following 
matrices are computed using double precision, 

ERROR = C + X - A*X*B (2) 

A*X1*B - XI = ERROR (3) 

If the Euclidean norm of XI is less than some tolerance (TOL) the 
iterative refinement procedure is terminated and X is the solution. 

If the norm is not less then some tolerance, X is updated, 

X = X + XI (4) 

substituted back into Eq. 2 and the iterative refinement procedure is 
performed again. If two successive values of the Euclidean norm of 
XI show the norms are increasing, the iterative refinement procedure 
is terminated. 
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2. USAGE 


a. Calling Sequence 

CALL SOLVER (A,ADUM,U,N,NA,B,DBUM,V,M,NB,C,CDUM,NC,X,WORKl,EPSA, 

EP S B , XDUM , TOL , ITER) 

b. Input arguments 

A,B,C Matrices packed by columns in one-dimensional arrays. Not 
destroyed upon return. Dimensions are A - N*N, B - M*M, 

C - N*M. 

ADUM, 

BDUM, 

CDUM, 

W0RK1 , 

XDUM, 

U,V Working space vectors of dimensions at least, ADUM - NA*NA, 

BDUM - NB*NB, CDUM - NC*NC, XDUM - N*M, W0RK1 - 2*(N*M), 

U - N*N, V - M*M 

ITER Integer scalar indicating the maximum number of iterative 
refinements attempted by the subroutine. If ITER ,LT. 0, 
no refinement iterations are performed. 

TOL Real scalar indicating the tolerance value used to determine 

if the norm of the equation error matrix is sufficiently small. 

N,M,NA, 

NB,NC Integer scalars indicating matrix dimensions. It is required 
that NA .GT. N+l, NB ,GT. M+l, and NC .GT. (MAX(N,M) +1) . 

EPSA, 

EPSB See AXBMXC subroutine description. 



c. Output Arguments 

X Upon normal return, X contains the solution to Eq. 1 packed 

by columns in a one-dimensional array. 

d. COMMON Blocks 
None 

e. Error Messages 

If the number of iterative refinements exceeds ITER or the iterative 
refinement proceed is unstable, the message "SYSTEM FAILED TO CONVERGE 
AFTER ITERATIONS. RESIDUAL NORM = " is printed. 

f. Subroutines Employed by SOLVER 

ORACLS - ADD, NORMS, BCKMLT , HSHLDR , SCHUR, SYSSLV 
PIFLIB - AXBMXC , SHRSOL 

g. Subroutines Employing SOLVER 

PIFLIB - CGTPIF 

h. Conclusing Remarks 

This subroutine is based on the algorithm reported m Ref. 3. 
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IV. SUMMARY - DESIGN PROCEDURE 


The design procedure for determining a PIF autopilot control law 
using the program PIFCGT is outlined below: 

Choose the control law sampling interval- DELT 
Specify convergence criteria- EPS, ECGT, TOL, ELOG 
Specify number of iterative steps- ITER MLOG, IKDGM 
Choose autopilot design- ICHOSE 
Specify ICH logicals 
Specify DEBUG logicals for print out 
Specify ICGT for feedforward matrix construction 
Determine the new values for the aerodynamic coefficients and 
reprogram AEROD accordingly 

Determine the BETA HOLD feedforward matrices for a number of 
different forward velocities. Compute a straight line 
approximation to the <f> to 6 feedforward matrix element 
in S22 using forward velocity as the independent variable. 
Reprogram HDCON based on the new straight line approximation. 
Choose the number of simulation time steps - IMAX 
Choose the simulation command magnitude - UMAG 

Choose the starting and stopping time for the simulation command - USTRT, 
USTP 

Specify the eigenvalue eigenvector printout- IFREEF, IFREEP 
Choose stabilization criteria DSTAB, DREAL 

Choose the design flight condition by specifying forward velocity- 
VTP 

Guess at the quadratic cost weighting matrices 
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Guess at the command model design parameters - GKDGM, GKPSI, ZDDMAX, 

ZCLOSE, ZDOMAX, AKl , AK2 , ZCLMAX, ZCLMIN, ZCDMAX, GKMIN, GKDSLP , 
GKDICP , GKDMAX 

Iterate at guessing command model design parameters until desired 
command model response is obtained 
Iterate at guessing cost function weighting matrices until a 

desired tradeoff is made between gain magnitudes, command 
response and closed-loop eigenvalues 
If the NAMELISTS in Appendix A are used, the only choices that should 
be required by the designer are for DELT, VTP, and the quadratic weights. 
AEROD and HDCON need not be modified if the NAVION aircraft is used for 
control design. 
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APPENDIX A 


NAMELISTS FOR AUTOPILOT DESIGNS 


This appendix presents the nine NAMELISTS used by 
design the autopilots in Ref. 1. Initial data values, 
and quadratic weights are identified in the NAMELISTS. 


PIFCGT to 
gain values 
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PIF CONTROL DESIGN FOR BETA HOLD AUTOPILOT 
$NAM1 

N-9, M-4* L-4, NM-2 ,» 

MM»2> 


ICHOSE-l. 

IKDGM-1, 

ZDDMAX- 5.0. 

ZCL0SE-9.00. 

AK2- 2 • CO * 

ZCLMAX-O. 3* 

ICH-250*.T . t 
ICH(1.4)-.T,» 

ICH(1,5)-.T., 

ICH(1,8)-.F., 

ICH(1*9)-«F.» 

ICH { 1 . 12 ) ■ • F • > 

ICH( 1# 13 ) -• F • 

ICH(2.2)-.T.> 

ICH(2,3)» .F.» 

ICH (2.7)-.T.> 

ICH(2#8)-.T.» 

ICH ( 2 . 12 ) ■ • F • > 

ICH(2»13)-.T. 

I CH( 2 . 11 ) ■ • T. > 

ICH { 2. 16) -.F. 

ICH (4 >2 )■ • T. . 

ICH ( 4# 3 ) • • F • > 

IC H ( 4 »6)*.T*. 

ICH ( 4.7) • .T. . 

ICH(4#10)-.F. > 

ICH(4.11)-.F. 

ICH(4.17)-.F.» 
ICH( 5 . 1 ) ■ • F • # 

ICH( 5 . 2 ) ■ • F • . 

ICH(5,5)-.T.. 

ICH(6>6)-.T.> 

SS-l.O. 

EPS-1. OE-12, 

ITEP-12. 

VTP-175.0. 

ICGT-5*1, 

ICGT ( 1) *3» 

EL0G-1.0E-10, 

MLOG-7, 


SNAM2 



XR-12*.F.> 

UR-4* .F • . 

* 

UMR-4*.F.> 


9 

$NAM3 



IMAX-192. 

IPUN-1, 

* 

USTP- 16*0. 0. 

UM AG ( 1# 1 ) -20. 

4> 

$NAM4 



IFREEF-O, 

IFREIG-O. 


0EBUM1- ,F.> 

DEBUM2-.F 


DE BUM6- • F. » 

DF BU14- • F • » 


DEBU24-.F., 

DE8U25* • F • . 


DEBU31-.F. » 

DE8U42-.F.* 


DEBU44-.F., 

DEBU46-.F.# 


DEBU49-.T. > 

DEBU53- • T. » 


$ 


GKDGM-0.0020# GKPSI-IO.OO* 
ZDOMAX-15,0# AKl-l.O# 
ZCLMIN-O.l, ZCDM AX-O. 8> 

ICH(1#6)-.F.> ICH( 1»7>-.F.» 
ICH(1,10)-.T.> ICH C 1*11)-.T.> 
ICH(1#14)-.F.# ICH< 1#16)-.T.> 
ICH<2*4)-.T., ICH{ 2>5)-.T., 
ICH{2,9)-.T.> ICH( 2# 10 ) ■ • T.» 
ICH ( 2 ; 14 ) ■ • F .# ICH( 2#15)-.F.# 

I CH ( 4> 4) T »# ICH(4,5)-.T.> 

ICH(4,8)«.T.# ICH( 4,9>-.T.# 
ICH(4,15)-.T.» ICH( 4# 16 ) ■ • F • » 

ICH( 5* 3 ) -.T.# ICH( 5,4)-.T., 

ECGT-l.OE-12, T0L-1.0E-12, 

ICGT(4)«2, ICGT (5 )-0* 

DREAL-0.90, I0REG-5+0, 


YR-4*.F., XMR- 12*. F • t 


UMAG- 16*0.0. USTRT-16 + 0.0. 

USTRT(1#1)-1.0.USTP (1>1 >-20.0* 


IFREEP-2, DELT -0. 1. 

DEBUM3-.F.. DEBUM4-.F.. 

DEBUNA-.F.. DE BU 22 s * T • . 

DE8U26- .F*> DEBU 27" • F • » 

DEBU43-.F.# METERS-. F., 

DEBU48- .T .. DEB4 16-.T •» 

DE8U54- .F. » 
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$NAM 5 

F«81*0.0# G-36+0.0# H»48*0.0# D-16+0.0# 

FM«4*0.0# GM-A+O.O# HM«8*0.0» 0M»8*0.0# 

$ 

$NAM6 

UBQ-O. OOE-OO# WBQ»0. OOE-OO# QBQ-0. 00E-00# THQ» 0. 00E-00# 
XIQ-0.0# ZIQ-0.0# VHQ-0. 00E-00# RBQ- ll.OE-OO# 

P8Q-0. OOE-OO# PHQ-10. OE-OO# P SQ-10. OE-OO# YlQ»0. OOE-OO# 
DTH»0. OOE-OO# DER-O. OOE-OO# DA-0.10E-00# DRR* 0.10E-00# 
OTHD-O. OE-OO# DERO-O. OOE-OO# OARD-7. OOE-OO# DRRO ■7.00E-00# 
Z1Q-0. OOE-OO# Z2Q"0» OOE-OO# Z3Q-3. OOE-OO, ZAQ- 2. 50E-00# 
UBDQ-O. OOE-OO# WBDQ- 0. OOE-OO# QBDQ- 0. OOE-OO# THDQ -0. OOE-OO# 
XIDQ-C. OOE-OO# ZIOQ-O. OOE-OO# VBDQ»0t00E-00# RBDQ-O. OOE-OO# 
PBDQ-C. OOE-OO# PHDQ-O. OOE-OO# P SOQ- 0. OOE-OO# YIDO-O.O# 

$ 

SAEROl 

$ 

SAER02 

s 

SNAM7 

EI-9+0.0# ER-9*0.Q# El-9*0.0# 

ERV»400*0.0# IEV-9+0# 
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PIF CONTROL DESIGN FOR ROLL SEL 

M-4, 


SNAM1 

N-9# 

MM-2# 

ICHOSE- 1 2# 
Z0DMAX-20. , 
AK2-9.00# 
ICH-250*.T,» 
ICH(1#^)-.T.# 
ICHC 1 # 8 ) - • F • # 
ICHC 1 # 12 ) ■ • F. > 
ICH(2»2)-.T.# 


ICHC 4# 10) ■ • F • # 

ICHC5#1)-.F.# 

ICH(5#5)-.T.# 

SS-1.0# 

ITER-10# 

ICGT-5*1# 

EL0G-1.0E-10# 

$ 

$NAM2 

XR-12*. F « # 
UMR-4* • F • # 

$ 

SNAM3 

I MAX- 1 52# 
USTP«16*0.0# 

$ 

SNAM4 

IFREEF-O# 

0EBUM1-.F.# 

DEBUM6-.F., 

DE 8U2 A — • F. » 
DEBU31-.F., 
DEBU44-.F.# 
DEBUA9-.T.# 

$ 


IKDGM-1# 

ZCLOSE-3.00# 

ZCLMAX-0.3# 

ICH(1#5)-.T.# 
ICH C 1#9)-.F.# 
ICHC 1#13)-.F.# 
ICH C 2# 3 ) ■ *F . # 


ICH ( *♦ # 7 ) ■ »T . # 

ICHU#11)-.F.# 

ICH(5#2)-.F., 

ICH(5#6)-.T.# 

EPS-1. 0E-10# 

VTP-1A5.0# 

IC GT ( 1 ) -3# 
MLOG-7# 


UR-4*.F.# 


IRUN-1# 

UM AG ( 1, 1 ) ■ 5 .0 # 


IFREIG-O# 

DEBUM2-.F.# 

DEBU14-.F.# 

DEBU25-.T • # 

DEBUA2-.F.# 

DEBU46- . F . , 

DEBU53-.T.# 


AUTOPILOT 
L- A# 

GK DGH-0 • 0020# 
ZDOMAX- 10.0# 
ZCLMIN-0.1# 

ICH(1#6)-.F.# 

ICH(1#10)-.T.# 

ICHC1#14)-.F.# 

ICHC2#4 )-.T.# 

ICH(2#9)-.T.# 

ICHC2#14)-.F.# 

ICHC4#*)-.T.# 

ICHC4#8)-.T.# 

ICHCA#15)-.T.# 

ICH(5#3)-.T.# 

ECGT-l.OE— 10# 

ICGT CM -0# 
DREAL-0.90# 


YR-4*.F •# 


UMAG- 16*0.0# 
USTRT ( 1, 1) -1 


IFREEP-2# 
DEBUM3-.F.# 
DEBUMA-.F.# 
DEBU2 6-.F.# 
DEBU43- .F •# 
DEBU48- • F. # 
DEBU5A-.F.# 


NM-2# 

GKPS 1-10.00# 
AK1- 6.0# 
ZCDMAX-0.8# 

ICHC 1#7)-.F.# 
ICH( 1#11)-.T«# 
ICH( 1# 16 ) ■ .T. # 
ICH ( 2#5)-.T.» 
ICHC 2#10)-.T.# 
ICHC 2#15)-.F.» 


ICHC A#5)-.T •# 
ICHC 4#9)-.T.# 
ICHC 4t»16)-.T.# 
ICHC 5#M-.T.# 

T0L-1.0E-10# 

ICGT C5) -0# 

IDRE G-5*0» 


XMR- 12* • F •# 


USTR T-16*0. 0# 

0 # USTP Cl#l )-20.0» 


DELT-0.1# 
DEBUMM. F. # 
DEBU22-.T.# 
DEBU 27-. F.# 
METERS-. T.# 
DEB416-.T.# 


ICHC2»7)-.T.# ICH(2#8)-.T.# 

ICHC2#12)-.F.# ICH C 2# 1 3 ) -. F. # 
ICHC 2# 11) ■ *T. # ICH C 2# 16 ) ■ • F . # 
ICHC4#2)-.T.# ICHC 4# 3)-. F«# 
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$NAN 5 

F"81*0.0, G-36*0.0, H"48*0.0, D»16*0.0, 

FM-4*0.0, GM«4*0.0, HM"8*0»0> DM-8+0.0, 

$ 

SNAM6 

UBQ"0. OOE-OO, WBQ«0. OOE-OO, QBQ-O. OOE-OO, THQ" 0.00 E-OO, 
XIQ-O.O, ZIQ-O.O, VHQ"0. OOE-OO, RBQ" 8.00E-00, 

PBQ-O. OOE-OO, PHQ-6. OOE-OO, PS Q»4 .00E-00, YIQ" O.OOE-OO, 
DTH«0. OOE-OO, DER-O. OOE-OO, DA-3.50E-00, DRR- 1.80E-00, 
DTHD-O. 06-00, DERO-0. OOE-OO, DARD" 3 • 50E-00, DRRD "4. OOE-OO, 
Z1Q-0. OOE-OO, Z2Q-0. 006-00, Z3Q-3. OOE-OO, Z4Q- 2.50E-00, 

UBDO-O, OOE-OO, WBOQ-O. OOE-OO, Q BDQ» 0. OOE-OO, THDQ-O, OOE-OO, 
XIDQ-O. OOE-OO, ZIDQ-O. OOE-OO, VBDQ- 0. 20E-00, R8DQ-0. OOE-OO, 
PBDQ-O.OOF-OO, PHOQ-O. OOE-OO, PSOQ-O. OOE-OO, YIDQ-O.O, 

$ 

SAEROl 

$ 

SAER02 

$ 

$NAM7 

El" 9* 0.0, ER"9*0.0, EI"9*0.0, 

ERV-AOO+O.O, IE V"9*0, 
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PIF CONTROL DESIGN FOR HDG SEL AUTOPILOT 
SNAM1 

N-9* M-4# L-4* 

MM-2* 


ICHOSE-6* 

ZD0MAX-5.0* 

AK 2-2 • 00 » 
ZCDMAX ■ 0.8* 
ICH«250*.T. * 
ICH ( 1*4)-. T.* 
ICHCl* 8)-.F.* 
ICHCl, 12)-. F., 
ICHCl*16)-.T. > 
ICH(2*2)-.T.* 
ICH(2*7)-»T.* 
ICHC2*12)-.F»* 
ICH ( 2 * 1 1 ) ■ • T • * 
ICHC4*2)-.T., 
ICHC4,6)-.T.* 
ICH C 4* 10 ) ■ • F • * 
ICH(5,1)-.F.* 
ICH(5*5)".T.* 
SS-1.0* 
ITER-12* 

ICGT- 5* 1* 

E LOG- 1. 0E-10* 

$ 

S NAN 2 

XR-12+.F •* 
UMR-4*. F. * 

$ 

SNAM3 

IMAX- 292* 
USTP-16*0.0* 


IKDGM-1* 
ZCLOSE-9, 00* 
ZCLMAX-O. 3* 


ICH ( 1*5)-. T.* 
ICHC1*9)-.F., 
IC H { 1*13)-. F.* 

ICH ( 2* 3 ) ■ . F • * 

ICH(2»8)-.T.* 

ICH(2*13)«.F.* 

ICH(2,16)».F.» 

ICH(4*3)-.F.* 

ICH( 4*7)- ,T.» 

ICH( 4* 1 1 ) » . F • * 

ICH(5*2)-.F.» 

ICH ( 5*6 )« .T. * 

EPS-1. OE-12* 

VTP-145.0* 

ICGT ( 1) -3* 
MLOG-7* 


UR-4+.F .* 


IRUN-1* 

UNAG (1*1) --45.* 


GKDGM-0.0020# 

ZD0MAX-15.0* 

ZCLMIN-0.1* 


ICH(1*6)-.F.* 
ICHC 1 * 10 ) ■ • T. # 
ICH(1,14)-.F.» 

ICH C 2 * 4 ) ■ • T •* 
ICH(2*9)-.T.» 
ICH(2*14)-.F.* 

ICH(4,4)-.T.» 

ICHC4*8)-.T.* 

ICH(5*3)-.T.» 

ECGT-1. OE-12# 

ICGT(4)-0* 

DREAL-0.90* 


YR-4 + , F. * 


UMAG- 16*0.0# 
USTRT ( 1# 1 ) *0. 


NM-2* 

GKPS 1-10.00# 
AK 1- 1.0# 

ZC DM AX-0 . 8* 


ICHC 1*7)-. F.# 
ICH( 1*11)-. T.* 
ICHC 1*15)-. T.* 

ICH( 2*5)-. T.# 
ICH( 2*10)-. T.* 
I CH ( 2*15)-. F.* 

ICHC 4*5)-. T.* 
ICHC 4*9)-. T.# 

ICHC 5*4)-. T.# 

TOL-1. OE-12# 

ICGT C 5 ) — 0 # 
IDREG-5*0# 


XMR- 12*. F.# 


US TR T-16*0. 0# 
5#UST PC1#1)- 30.0# 


$ 

$NAM4 

IFREEF-2* 
DEBUM1-.F. » 
0EBUM6-.F.* 
DEBU24-.F.* 
DEBU31-.F. * 
DEBU44-.F.* 
0EBU49-.F. » 

$ 


IF RE IG- 0 # 
DEBUM2-.F.* 
DEBU14- . F • * 
DEBU25-.F.* 
DEBU42- . F . » 
DEBU46- • F • » 
DEBU 53- • T. * 


I FREEP-2# 

DEBUM3-.F.# 

DEBUMA-.F.* 

D E BU2 6- . F . * 

DEBU43-.F.* 

DEBU48- .T.* 

DEBU54-.F.# 


DELT-0.1* 

DEBUM4-.F.* 

DEBU22-.F.* 

DEBU27-.F.# 

METERS-.T.* 

DEB416-.T.* 
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SNA^5 

F«81*0.0, 

FM»4*0.0, 

$ 

$NAM6 

UBQ-O.OOE-OO, 

XIQ-O.O, 

PBQ**0.00E-00> 

OTH-O.OOE-OO# 

DTHD-O.OE-OO, 

ZlQ-O.OOE-OO, 

UBDQ-O.OOE-OO* 

XIDQ-O.OOE-OO# 

PBDQ«0.OOE-OO> 


G* 36*0 . Ot 
GM-4+0.0, 


WBQ-O.OOE-OOj 

ZIQ-O.O, 

PHQ" 10. OE— 00 > 

DER-O.OOE-OO# 

DERD«0.00£-00> 

Z2Q-O.OOE-O0» 

WBDQ-O.OOE-OO* 

ZIDQ*0. OOE-OO# 

PHDQ-O.OOE-OO* 


H«48*0.0> 

HM*8*0.0> 


QBQ-O.OOE-OO, 
VHQ-O.OOE-OO* 
PSQ-10.0E-00, 
0A“0. 10E-00# 
DARO-7. OOE-OO, 
Z 3 Q«3 . OOE-O0> 
QBDQ«0.00E-00, 
VBDQ-O.OOE-OO, 
PSDQ" 0. OOE-OO* 


$ 

t AERQ1 
$ 

SAER02 

$ 

$NAM7 

E I "9*0 • Or ER«9*0.0> EI»9*0.0> 

ERV-400+0.0. IEV-9+0, 


$ 


D"i6 *0.0> 
DM-8 *0.0> 


THQ-O.OOE-OO# 
RBQ-ll.OE-OO# 
YIQ-0.00E-00> 
DRR» 0.10E-00* 
DRRO »7 • OOE-OQ* 
ZAQ" 2. 50E-00# 
THDQ-O.OOE-OO* 
RBDQ-O.OOE-OO, 
YIDQ-O.O, 
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PIF CONTROL DESIGN FOR APR LOCI AUTOPILOT 
$NAM1 

N-9. M- 4. L-4. NM-2. 

MM-2. 

ICHOSE-9. IKOGM-IO. GKDGM-0 . 002 5. GKPSI-5.000. 

ZDDMAX-10.. ZCL0SE-15.0. ZD0MAX-360.. AK1-0.114. 

AK2-1.20. ZCLMAX-O. 3. ZCLMIN-O.l. ZCDMAX-0.5, 

GKDMIN ■ 0.11. GKDSLP— 0.0020. GKDICP-O. 20# GKDMAX-0.22. 
ICH-250*.T • . 

ICH(1.4)-.T.» ICH(1,5)- .T. > ICH{ 1 . 6 ) ■ . F . > ICH ( 1, 7) ■ • F .. 

ICH ( 1 .8 ) ■ • F • . ICH{1.9)-.F.» I CH ( 1, 10) ■ . T. . I C H( 1.11 >-.T.» 
ICH(1»12)-.F.» ICH(1.13)«.F.. ICH ( 1 . 1 4 )■ . F . . ICHC 1.16) -.To 
I CH( 2, 2)-.T., ICH(2.3)-.F.» I CH ( 2. A ) -. T. . ICHl 2.5) ■ .T .» 

ICH (2.7) T. . ICH(2.8)-.T.» I CH ( 2 #9 ) -.T . . ICHC 2.10) ■ .To 

ICH(2»11)-.T.. I CH ( 2. 12 ) ■ .F • . ICH ( 2 . 13 ) ■. F. . I C H ( 2.14 ) ■ . F.. 
ICH ( 2^ 15) - • F. > ICH(2.16)-.F.» 

ICH(4,2)«.T.. ICH(4,3)-.Fo ICH ( 4 . 4 ) • .To ICH(4.5)-.To 

ICH(4.6)-.T., ICH(4.7)-.To ICH(4.8)-.To ICH(4.9)-.To 

ICH ( 4 . 10) * • F • . ICH(4»11)-.F.# ICH(4.15)-.To IC H(4> 16 ) ■ .T. # 
ICH(5»1)*.F.» ICH ( 5. 2 ) ■ • F • . IC HC 5 . 3 ) » . T . . IC H( 5.4 ) ■ . To 
ICH(5,5)-.T., ICH(5.6)-.To 

SS-l.O, EPS-1. 0E-10. ECGT-1.0E-10. TOL- 1.06-10. 

ITER-10. VTP-145.0. 

ICGT-5*1. ICGT(l)-3, ICGT(4)-0. ICGT(5)-0. 

ELOG-1. 0E-10. MLOG-7, DREAL-0.90. IDREG-5*0. 

$ 

SNAM2 

XR-12*. F o UR-4*.Fo YR-4+.F.. XMR-12*.Fo 

UMR- 4* • F • » 
t 

$NAM3 

I MAX- 348. IRUN-1. UMAG-16+0.0. USTR T-16*0. 0. 

USTP- 16*0.0. UMAG(1. 1) - 500 . . US TRT ( 1 . 1 ) -0. 0 .USTP (1.1)- 30.0. 
UMAG (2.1)-45. , USTRT(2.1)»0.0.USTP< 2.1) -30,0. 

$ 

$NAM4 

IFREEF-O. IFREIG-O. IFREEP-1. DELT-0.1. 

DEBUM1-.F., 0EBUM2-.F.# DEBUH3- • F ,. DEBUH4-.F.. 
DEBUM6-.F. » DE8U14- . F • , DEBUMA-.Fo DEBU 22-.T.. 

DEBU24-.F*. DEBU25-.T.. DEBU26-.F.. DEBU27-.F.. 

0E8U31-. F, , DEBU42-.F., DEBU43-.F.. METERS-. T.. 

DEBU44-. F. . DEBU46-.F.. DEBU48-.F.. DEB416-.T.. 

D EBU49- • T. . DEBU53-.T.. DEBU54- .F.» 

$ 


155 



SNAM5 

F-8 1*0. 0#' * 

FM-4+0.0# 

$ 

$NAM6 

UBQ-0.00E-00# 

XIQ-0.0# 

PBQ-0.00E-00# 

DTH-0.00E-00# 

DTHD-0.0E-00# 

Z 19- 0 • 00E-00# 
UBDQ-0.00E-00# 
XIDQ-O. OOE-OO# 
PBD9-0. 00E-00# 

$ 

SAFROl 

$ 

SAER02 

$ 

SNAM7 

EI-9+0.0# 

ERV-400+0.0# 


G« 36*0. 0# 
GM- 4*0. 0# 


H-48+0.0# 

Hh-8+0.0# 


0>16*0.0# 

DM-8*0.0» 


WBQ-O.OOE-OO# 

Z19-0.0# 

PHQ-10.0E-00# 

DER- O.OOE-OO# 

DERD- O.OOE-OO# 

Z29-0.00E-00# 

WBDQ-O.OOE-OO# 

ZIDQ-O.OOE-OO# 

PHDO-O.OOE-OO# 


QBQ-O.OOE-OO# 
VHQ-O.OOE-OO# 
PSQ-14.0E-00# 
DA-0.10E-00# 
DARD- 7 • OOE-OO# 
Z3Q-2.50E-00# 
QBDQ-O. OOE-OO# 
VBDQ-O. OOE-OO# 
P SD9-0. OOE-OO# 


THQ-O. OOE-OO# 
RBQ- ll.OE-OO# 
YIQ- O.OOE-OO# 
DRR- 0.10E-00# 
DRRD-7. OOE-OO# 
Z 4Q- C. 50E-00# 
THDQ-O. OOE-OO# 
RBDQ-O. OOE-OO# 
YID9-0.0# 


PR-9 + 0.0# £ 1-9*0. 0# 

IEV-9+0# 


156 



PIF CONTROL DESIGN FOR APR LOCR AUTOPILOT 
SNAM1 

N-9# M-4# L-4# NM-2# 

MM ■ 2 # 

ICHOSE-15# IKDGM-1# GKDGM-0.0020# GKPSI-3.00# 

Z DOMAX- 10. # ZCL0SE-15.0# ZD0MAX-360.# AK1-0.114# 

AK2-1.20# ZCLMAX-0.3# ZCLMIN-O.l# ZCDMAX-0.5# 

GKDMIN ■ O.ll# GKDSLP--0.0020#GKDICP-0.20# GKDMAX-0.22# 
ICH-250*.T.» GKY-0.30# 

ICH( 1#4)«.T.# ICH(1#5)-.T.» ICH(1#6)-.F.# ICH ( 1# 7>- . F .# 

ICH(1#8)».F. # ICH ( 1>9 )■ .F»# ICH( 1# 10)- .T.# ICH< 1# 11 ) ■ . F . # 
ICH( 1 # 12 ) » • F • # ICH(1#13)-.F.# ICH< 1# 14) «.F.* ICH( 1# 16 > -. T. # 
ICH{2#2)».T.# ICH(2#3)-.F.# I CH( 2 # 4 ) • .T . > ICH( 2# 3) ■ .T • # 

ICH<2#7)-.T.# ICH(2#8)-.T.# I CH { 2 >9 ) • .T . # ICH{ 2# 10 ) • • T. # 

ICH ( 2 # 12 ) ■ • T. # ICH ( 2# 13 ) ■ • F • # ICH{2» 1 <r ) - . F • ^ I CH( 2# 15 ) • . F . » 
ICH(2#11)-.T.# ICH ( 2# 16 ) ■ • F • # 

ICH(4#2)-.T.# ICH(4#3)-.F.# ICH<4#4)-.T.# ICH( 4* 5 )• .T.# 

ICH(4,6)-.T.# 1CH(4#7)-.T.# ICH <4, 8 > • . T .# ICH< 4# 9 ) ■ .T .# 

ICH < 4# 10 ) ■ • F • » ICH(4#11)-.F.# I C H< 4 # 15 ) ■ . T. # IC H<4# 16)-. T., 
ICH(5#1)-.F., ICH( 5#2)-.F., ICH < 5 # 3 > -. T . # IC H( 5,4) • .T.# 
ICH(5#5)-.T.# ICH<5,6)«.T.# 

SS-1.0# EPS-1. OE-IO# ECGT-1.0E-10# TOL- 1.0E-10# 

ITER-10# VTP-145.0# 

ICGT-5*1# ICGT ( 1 ) -3# ICGT(4)-0# ICGT<5)»0# 

EL0G-1.0E-10# MLQG-7# DREAL-0.90# IDREG-5*0» 

i 

SNAM2 

XR-12*.F •# UR-4*.F.# YR-4+.F.# XMR-12*.F.# 

UMR-4* • F • # 

S 

$NAM3 

I MAX- 34 6# IRUN-1# UMAG«16*0.0# USTR T-16* 0. 0# 

US TP- 16*0.0# UMAG(1» 1 ) - 500 . # USTRT ( 1 , 1 ) -0. 0 # USTP <l#l)-30.0» 

IJMAG ( 2# 1 )-45 , > USTRT(2#1)-0.0#USTP(2#1)-30.0# 

$ 

SNAM4 

IFREEF-O# IFREIG-O# IFREEP-1# DELT-0.1# 

DEBUM1-.F. # 0EBUM2-.F.# DE BUM3- • F . # 0EBUM4-.F.# 

DEBUM6-.F.# DEBU14-.F.# DEBUMA-.F.# 0EBU22-.T.# 
0EBU24-.F.# 0EBU25-.F.# DEBU26-.F.# 0EBU27-.F.# 

0EBU31-.F.# 0 EBU42- • F • # DEBU43-.F.# METERS-. T.# 

DEBU44-.F.# DEBU46-.F.# DEBU48-.F.# DEB416-.T,# 

DEBU49- .T. # DEBU53-.T.# DEBU54-.F.# 
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SNAM5 

F«81*0.0# 

FM-4+0.0# 


G- 36*0. 0# 
GM-4*0.0» 


H-48*0.0# 

HM-8*0.0# 


$ 

$NAM 6 

UBQ-0.00E-00# 

XIQ-0.0# 

PBQ-O.OOE-OO# 

DTH-0.00E-00# 

DTHD-0.0E-00# 

Z1Q»0.00£-00# 

UBDQ-O.OOE-OO# 

XIDQ-0.00E-00# 

PBDQ-O.OOE-OO# 


WBQ-0. 006-00# 

ZIQ-0.0# 

PHQ-10.0E-00# 

DER-0.00E-00# 

DERD-O.OOE-OO# 

Z2Q-0.00E-00# 

WBDQ-O.OOE-OO# 

ZIDQ-O.OOE-OO# 

PHDQ-O.OOE-OO# 


QBQ-O.OOE-OO# 

VHO-O.OOE-OO# 

P SQ-1 1 • OE-OO# 

DA-O. 10E-00# 

DARD-7.00E-00# 

Z3Q-1. 006-00# 

QBDQ-O.OOE-OO# 

VBDQ-O.OOE-OO# 

PSDQ-O.OOE-OO# 


$ 

SAER01 

S 

SAER02 

$ 

$NAM7 

ER -9*0. 0# 61-9*0.0# 

IEV»9*0# 


EI-9+0.0# 

ERV»400*0.0# 


S 


0-16*0.0# 
DM-8 *0.0# 


THQ- O.OOE-OO# 
RBQ- ll.OE-OO# 

Y I Q- O.OOE-OO# 
DRR- 0. 10E-00# 
DRRD -7.00E-00# 
Z4Q- 2.20E-00# 
THOQ -O.OOE-OO# 
RBOQ -O.OOE-OO# 
YIDQ-O.O# 
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PIF CONTROL DESIGN FOR APR LOCP AUTOPILOT 
SNAM1 

N-9, M-4# L-4# 

MM-2 # 


ICHOSE-16# 
ZDDMAX-10. # 
AK2-1.20# 
ZCDMAX ■ 0.5# 
GKDMIN ■ 0.11# 
ICH-250*.T. > 
ICH(1#4)-.T.» 
ICH<1#8)-.F.# 
ICH(1#12)«.F.# 
ICH(2#2 ) ■ • T. # 
ICH(2#7)-.T.# 
ICH ( 2 # 12 ) • • T • # 
ICH ( 2 # 11 ) ■ • T. # 
ICH(4#2)-.T.# 
ICH(4#6)«.T.# 
ICH ( 4 # 10 ) ■ • F • » 
ICH(5#1)-.F.# 
ICH(5#5)-.T.# 
SS-1.0# 
ITER-10# 

ICGT- 5* 1# 
ELOG-l.OE-lO# 

$ 

$NAM2 

XR-12*.F»# 

UMR-4*.F.# 

$ 

$NAM 3 

I MAX* 34 6# 

USTP- 1 6*0 • 0# 
UMAG ( 2 # 1) ■ 45. # 

$ 

$NAM4 

IFREEF-O# 
DEBUM1-.F,# 
DEBUM6-.F. # 
DEBU24-.F. » 
DEBU31-.F. # 
DEBU44-.F • # 
DEBU49-.T.# 


IKDGM-1, 

ZCL0SE-15.0# 

ZCLMAX-0.3# 


ICH ( 1 » 5 ) ■ .T • # 

ICH(1#9)-.F.» 

ICH(1#13)-.F.# 

ICH ( 2# 3 ) ■ . F • # 

ICH(2#B)-.T.# 

ICH(2#13)-.F.# 

ICH(2#16)-.F.# 

ICH(4#3)-.F.» 

ICH ( A# 7 ) ■ • T. # 

ICH ( 4# 1 1 ) ■ • F • # 

ICH ( 5# 2 ) ■ • F • > 

I CH ( 5# 6 ) ■ . T • # 
EPS-1. 0E-10# 
VTP-150.0# 

I CGT ( 1 ) -3# 
MLOG-7# 


UR-4*»F . # 


IFREIG-O# 
DEBUM2- . F • # 
DE8U14-.F .# 
DEBU25-.F.# 
DEBU42- .F.» 
DEBU46- .F .# 
DEBU53-.T.# 


GKDGM-0 • 0020# 
ZDOMAX- 360. # 
ZCLMIN-0.1# 


ICH(1#6)-,F.# 

ICH(1#10)-.T.# 

ICH(1#14)-.F.# 

ICH(2#4)«.T.# 

ICH(2#9)-.T •# 

ICH(2#14)-.F.# 

I CH( 4 # A ) ■ .T • # 
ICH(4,8)«.T.# 
ICH(4,15)-.T., 
ICH(5#3)-.T.» 

ECGT-1.0E-10# 

ICGT( 4) -0# 
DREAL-0.90# 


YR-4* • F. # 


I FREE P- 1# 

DEBUM3-.F.# 

DEBUMA-.F.# 

0EBU26-.F.# 

DEBU43-.F.# 

DEBU48-.F.# 

DEBU54-.F.# 


NM-2 # 

GK PS 1-4.00# 
AK1-0.114# 
ZCOMAX-O. 5# 

ZS — 0.00# 
GK0MAX-0.22# 

ICH( 1# 7) - • F •# 
ICH( 1# 11 )■ . F. # 
ICH ( 1#16)-.T«# 
ICH( 2# 5 ) ■ .T .# 
ICH( 2#10)-.T.# 
ICH ( 2#15)».F.# 

ICH( 4# 5) - *T .# 
ICH( 4# 9 ) - • T •# 
ICH(4#16)-.T.# 
ICH( 5,4)-. T.# 

TQL-1.0E-10# 

ICGT (5)-0# 

I ORE G-5*0# 


XMR- 12*. F.# 


DELT-0.1# 
DEBUM4-.F.# 
DEBU22-.T.# 
DEBU 27- • F • # 
METERS-. T., 
DEB4 16-.T.# 


XS-O.OO# YS-O.O# 

GKDSLP-~0.0020#GKDICP-0.20> 

GKY-0.70# 


IRUN-1# UMAG- 16*0.0# US TR T-16*0. 0# 

UMAG t 1# 1 ) -500.# USTRT ( 1# 1 ) -0,0#USTP (1#1 )-30.0# 
USTRT (2#l)-0.0»USTP(2»l)-30.0# 
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SNAM5 


F“81*0« 0> 
FP«4*0.0> 

$ 

SNAM6 

UBQ-O.OOE-OO* 

XIQ-0.0 t 

PBQ»O.OOE-O0> 

DTH-O.OOE-OO, 

DTHD-O.OE-OO* 

ZIQ-O.OOE-OO, 

UBDQ-O.OOE-OO* 

XIDQ-O.OOE-OO# 

PBDQ-O.OOE-OO, 

$ 

SAEROl 

$ 

SAER02 


G»36*0.0> 
GM»A*0.0 > 


WBQ-O.OOE-OO# 

ZIQ-O.O, 

PHQ«8»00E-00> 

DER»O.OOE-O0» 

DER0»0.00E-00> 

Z2Q-0.00E-00> 

WBDQ“0« OOE-OO* 

ZIDQ»0.00E-00> 

PHDQ-O.OOE-OO, 


H-48*0.0> 

HM»8+0.0> 


QBQ-O.OOE-OO# 

VHQ-O.OOE-OO, 

PS0-14.0E-00# 

DA-O.IOE-OO# 

D ARD* 7 • OOE-OO* 

ZB0«1.00E-00» 

QBDQ-O.OOE-OO* 

VBDQ-O.OOE-OO* 

PSDQ-O.OOE-OO* 


$ 

SNAM7 

ER-9+0.0, EI-9*0.0> 

IEV-9+0# 


EI-9+0.0, 

E RV B/ t00*0« Of 


D-16*0.0# 
DM-8 *0.0> 


THQ-O.OOE-OO# 

RBQ-ll.OE-OO* 

YIQ-O.OOE-OO# 

DRR-0.10E-00, 

DRRD-7.00E-00# 

Z4Q« 2.20E-00* 

THDQ*0.00E-00> 

RBDQ-O.OOE-OO, 

YIDQ«0.0» 


160 



PIF CONTROL DESIGN FOR PITCH SEL AUTOPILOT 
SNAM1 

N-9# M-A# L-A# NM-2# 

' mm-2# 

ICHOSE-A* IKDGM-1# GKDGM -0 . 0020# GKPSI-10.00# 

ZDDMAX-0.75* ZC LOSE- 19 . 6b > ZD0MAX-8.30# AK1-0.8# 

AK2-2.00* ZCLMAX-2.0* ZCLMIN-O.A# ZCDMAX-0.3# 

GKDMIN-O.OA# GKDSLP — 0 . 000 A# GK D IC P-0 , 07# GKDHAX-0.07# 

ICH-250*.T.# 

ICH ( 1 # A ) ■• T. * ICH(1#5)-.T.» I CH t 1 # 6 ) » .F . > ICHC 1# 7 » - • F .# 

ICH(1#8)«.F.# ICH(1#9)».F., IC H t 1 #10 ) - . T. # ICH( 1#11 ) ■ . T. # 

ICH(1*12)-.F.» ICH(1#13)-.F.# ICH( 1#1A)-.F.# ICHt 1# 15 ) -.T. # 
ICH(1#16)«.T.» 

ICHt2*2)*.T»# ICH(2#3)-.F.# I C H l 2 # A ) - . T . # ICH( 2# 5 ) - • T.# 

ICH(2#7)-.T .# ICH(2#8)-.T.# ICHt2#9)».T.# ICHt 2# 10) -.T. # 

ICH(2#12)-.T.* ICHt2#13)«.F.* I CH( 2# 1 A ) ■ • F . # ICHt 2# 15 > ■ . F. # 
ICH(2#11)-.T.# ICH(2#16)«.F., 

ICH t A # 2 ) ■• F • # ICHt A#3)-.T.# ICH ( A# A ) - .T . # ICHt A#5> -.T .# 
ICH(A*6)«.T.* ICHt A, 7)-. T.# I C H ( A # 8 ) • .T . # ICHt A#9) ■ .T.» 
ICHtA*10)-.F., ICHt A, 11)-. F. , 

ICH t 5 # 1 ) ■ • F • # ICri(5#2)-.F.» ICH t 5 , 3 ) ■ . T . # ICHt 5#A) -,T .# 

ICH t 5 # 5 1 ■ • T • # ICH(5#6)-.T.# 

SS-1.0, EPS-1. 0E-10# ECGT- 1 • Ofc-lO# T0L-1.0E-10, 

ITER-10* VTP-150.0# 

ICGT-5+1. IC GT ( 1) ■ 3 » ICGT(A)-0# ICGT t5)-0# 

ELQG- 1. 0E-10# MLOG-7* 0REAL-0.90# IDREG-5+0# 

$ 

SNAM2 

XR- 1 2* • F • # UR- A* .F • # YR-A* .F . # XMR-12*.F.# 

UMR-A+.F.# 

S 

$NAM3 

I MAX-198* IRUN-1* UMAG-16*0.0# USTR T-16*0. 0# 

t USTP-16*0.0# UMAG 1 1* 1 ) -5. 00# USTRT ( 1# 1) *1* 0#USTP tl#l ) -30. 0 # 

s 

SNAMA 

IFREEF-1# IFREIG-O# IFREEP-1# DELT-0.1# 

DE BUM 1- . F • » DEBUM2-.F.* D EBUM3- • F. # DEBUMA-.F.# 

D t BUM6 ■ . F. » DEBU1A-. F • » DEBUMA-.F.# DEBU22-.T.# 

DEBU2A-.F. » DEBU25-.F.* DE8U26-.F.# DEBU27-.F.# 

0EBU31-.F.* DEBUA2-.F.* DEBUA3-.T.# METERS-. T.# 

DEBUAA-.F.# DEBUA6- .F .# DEBUA8-.F.# DEBA16-.T.# 

DEBUA9- • F. » DEBU53- .T • * DEBU5A-.F.# 

$ 
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SNAM5 

F-81+0.0, 

FM-4*0.0> 

$ 

$NAM6 

UBQ-O.OOc-OO, 

XIQ«0.0» 

PBQ-O.OOE-OO, 

DTH«O.OOE-O0> 

OTHP-O.OE-QO, 

Z 1Q*3 • 000E-00 > 
UBDQ-O.OOt-OO* 
XIDQ»0«OOE-00> 
PBDQ-O.OOE-OO* 

$ 


G«36*0.0, 

GM-A+O.O, 


W8Q«O.OOE-O0> 

ZIQ-0.5* 

PHQ* 0 • 0OE“OO t 

DER"0.00E-00> 

OERD "7» 00E-00 t 

Z2Q-3.000E-00» 

WBDQ*0« OOE-OOj 

ZIDQ»0.00E-00> 

PHDQ-O.OOE-OO# 


H-A8*0.0# 

HM-8*0.0> 


QB Q*0 • OOE— 00* 

VHQ-O.OOE-OO, 

PSQ-O.OOE-OO* 

DA-O.OOE-OO* 

DARD"0.00E-00> 

Z 3Q"0 • OOE-OO* 

QBDQ-O.OOE-OO* 

VBDQ-O.OOE-OO* 

PSDQ-O.OOE-OO* 


SAEROl 

% 

SAER02 

$ 

SNAM7 

ER-9+0.0* EI-9+0.0* 

IEV-9*0* 


EI»9*0.0> 

ERV-400+0.0# 


D-16+0.0* 

0M-8*0.0# 


1HQ-8.00E-00, 
RBQ" 0»00E— 00»' 
YIQ-O.OOE-OO, 
DRR-O.OOE-OO, 
DRRD-O.OOE-OO* 
Z4Q-0.O0E-0O* 
THDQ-O.OOE-OO* 
RSOQ »0» OOE-OO* 

YIDO-O.O* 
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PIF CONTROL DESIGN FOR ALT SEL AUTOPILOT 
SNAM1 


N-9# 

MM-2# 

M-A# 

L ■ A# 

NM-2# 

ICHOSE- 7# 

IKDGM-1# 

GKDGM-0.0020# 

GKPSI-10.00# 

ZDDMAX-0.75# 

ZCLOSE-19.60# 

Z DOM AX- 8 • 30# 

AK1-0.8# 

AK2-2.00# 

ZCLMAX-2.0# 

ZCLMIN-O. A# 

ZCDMAX-0.3# 

GKDMIN-O.OA, 

ICH-250+.T., 

GKDSLP--O.OOOA#GKDICP-O.07> 

GKDM AX-0.07# 

ICH(1,A)-.T., 

ICH(1,5)«.T.# 

ICH(1#6)«.F.# 

I C H C 1#7)-.F.# 

ICH(1#8)-.F. # 

ICH(1,9)-.F.# 

ICH(1#10)-.T.# 

ICH( 1#11)-.T.# 

ICH(1#12)-.F«# 

ICH<1#16)-.T.# 

ICH ( 1# 13 ) * »F • # 

ICH( 1# 1 A ) ■ . F • # 

ICH( 1#15)-.T.# 

ICH(2#2)-.T.# 

ICH(2#3)-.F.# 

ICH(2#A)-.T.# 

I C H ( 2# 5) ■ *T •# 

ICH(2#7)-.T.# 

ICH<2#8)-.T.# 

ICH(2#9)-.T.# 

ICH( 2#10)-.T.# 

ICH( 2 # 12 ) ■ . T. # 
I C H ( 2# 11) -.T* » 

ICH(2#13)-.F.# 

ICH(2#16)-.F.# 

1CH(2#1A)-.F.# 

ICH( 2# 15 ) - • F. # 

ICH(A#2)«.F.» 

ICH( A#3)-.T.# 

ICH(A#A)«.T.# 

ICH( A#5)-.T.# 

ICH(A#6)».T.# 
ICH(A#10)-.F. # 

ICH C A#7)-.T., 
ICH(A#tl)-.F.# 

ICH(A#8)-.T.# 

ICHt A#9)-.T.# 

ICH(5#1)".F«# 
ICH( 5# 5 ) ■• T. # 

ICH ( 5# 2 ) ■ • F • > 
ICH(5#6)-.T.# 

ICH( 5# 3 ) - *T«# 

I C H ( 5# A ) - • T.# 

SS-l.G# 

ITER-10# 

EPS-1. OE-IO# 
VTP-150. 0# 

ECGT- l.OE-10# 

TOL- 1.0E-10# 

ICGT»5*1# 

ICGT ( 1) -3# 

ICGT ( A ) -0# 

ICGT (5) -0# 

ELOG-l.OE-lG# 

$ 

SNAM2 

MLOG-7# 

DREAL-0 .90# 

IDRE 6-5*0# 

XR-12*.F.# 
UMR- A* • F • # 

UR-A*.F.# 

YR-A*.F.# 

XMR- 12*. F.# 


$ 


$NAM3 


IMAX-298# 

IRUN-1# 

UMAG- 16*0.0# 

USTR T-16*0. 0# 

USTP-16*0.0# 

* 

UM AG ( 1* 1 ) ■ 100 

. > USTRT (1# 1) -1 

• 0#USTP (1# 1 ) -30, 0# 

5NAMA 




IFREEF-1# 

IFR6IG-0# 

IFREEP-1# 

DELT-0.1# 

0EBUM1- .F.# 

DE8UM2- • F • # 

DEBUM3-.F.# 

DEBUMA-.F.# 

DEBUM6-.F. # 

DEBU1A- . F . # 

DEBUMA-.F.# 

DEBU22-.T.# 

0EBU2A-.F., 

DEBU25- • F •> 

DEBU26-.F.# 

DEBU 27-.T .# 

DEBU31-.F. # 

D EBUA2- • F . # 

DEBUA3-.F.# 

METERS-. T.# 

DEBUAA-.T. , 

DEBUA6- . F . # 

DEBUA8-.F.# 

DEBA16-.T.# 

DEBUA9- « F. » 

DEBU53-.T •# 

DEBU5A-.F.# 



$ 
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t* 4* 


$NAM5 

F«81*0.0* G-36*0.0* 

Ff«-4*0.0* GM"A*0« 0# 


H-48*0.0* 

HM»8*0.0* 


NAP6 

UBQ« 0 • OOE-OO* 
XIQ-O.O* 

PBQ-O. COE-OO* 
DTH-O. OOE-OO* 
DTHO-O.OE-OO* 
Z1Q«0. OOE-OO* 
UBDQ-O. OOE-OO* 
XIDQ-O. OOE-OO* 
PBDQ-O. OOE-OO* 

$ 

$ AER01 


WBOO. OOE-OO* 
ZIQ-0.5* 

PHQ-O. OOE-OO* 
DER-O. OOE-OO* 
DERD-7. OOE-OO* 
Z2Q"0. 25E-00* 
WBDQ-O. OOE-OO* 
ZIDQ-1. OOE-OO* 
PHDQ-O. OOE-OO* 


QBQ-O. OOE-OO* 
VHQ-O. OOE-OO* 
PSQ-O. OOE-OO* 
DA-O. OOE-OO* 
DARO-O. OOE-OO* 
Z3Q"0 .OOfc-OO* 
QBOQ-O. OOE-OO* 
VBDQ-O. OOE-OO* 
PSDQ-O. OOE-OO* 


$ 

SAER02 

$ 

$NAf*7 

ER-9*0.0* EI-9+0.0* 

IEV-9+0, 


EI-9*0.0* 

ERV-400+0.0* 


0-16*0.0* 
D M-8 *0.0* 


THQ- 14.0E-00* 
RBQ-O. OOE-OO* 
YIQ-O. OOE-OO* 
DRR-O. OOE-OO* 
DRRD-O. OOE-OO* 
Z4Q-0. OOE-OO* 
THDQ-O. OOE-OO* 
RBDQ-O. OOE-OO* 
YIDQ-O.O# 
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PIF CONTROL DESIGN FOR APR GS AUTOPILOT 
$ NAM1 



N-9, 

MM-2, 

M-A, 

L-A, 

NM-2, 


ICHOSE- 1A, 

IKDGM-1, 

GKDGM-0.0020, 

GKPS 1-10.00, 


ZDDMAX-0.03, 

ZCLOSE-O.OO, 

Z DOMAX-O .00, 

AK1-C.0A, 


AK2-0.00, 

ZCLMAX-O.O, 

ZCLMIN— 5.0, 

ZCDM AX-3.0, 


GKDMIN ■ O.OA, 
ICH-250+.T • , 

GK DSL P--O.OOOA,GKDICP- 0.07, 

GKDMAX-0.07, 


ICH ( 1, A ) ■• T. , 

ICH(1,5)-.T., 

ICH( 1 ,6 ) ■ • F • , 

ICH(1,7)-.F., 


ICH ( 1, 8 )■ • F • , 

ICH C 1,9 )■ .F. » 

ICH(1,10)-.T., 

ICH{ 1,11)-. T., 


ICH(1,12)-.F., 

I C H C 1,13)-.F., 

ICH(1,1A)-.F., 

ICH( 1,16)-. T., 


ICH(2,2)-.T., 

ICH(2,3)-*F., 

ICH(2,A)-.T., 

ICH< 2, 5 ) ■ ,T ., 


ICH(2,7)-.T., 

ICH( 2, 8 ) ■ . T. , 

ICH(2,9)-.T., 

I C H ( 2,10)-.T., 


ICH(2, 12)-.T.» 
ICH(2,11)-.T., 

IC H ( 2,1 3 ) ■ • F • , 
ICH ( 2, 16) ■ • F • , 

IC H( 2 , 1 A ) ■ • F. , 

ICH ( 2,15)-. F., 


ICH(A,2)-.F., 

ICH( A,3)-.T., 

ICH C A, A ) ■ . T. , 

ICH( A, 5)-.T., 


XCH(A,6 )-.T., 

ICH ( A, 7 ) - #T • , 

ICHC A, 8 ) -«T ., 

ICH( A, 9) -.T ., 


ICH(A,10)-.F. , 

XCH ( A, 11) ■ • F • , 

ICH(A,15)-.T., 

ICH( A,16)-.T., 


ICH ( 5 , 1 ) • • F • , 
ICH(5,5)-.T., 

ICH(5,2)-.F., 
IC H ( 6, 6 ) ■ »T » , 

ICH(5,3)-.T., 

ICH( 5, A)-.T., 


SS-l.O, 

ITER-10, 

EPS-1. 0E-10, 
VTP-150.0, 

ECGT-1.0E-10, 

T0L-1.0E-10, 


ICGT-5+1 , 

ICGT ( 1) -3, 

ICGT ( A ) -0, 

ICGT (5)-0, 

ELOG-l.OE-lO, 

$ 

$NAM2 

MLOG-7, 

DREAL-0.90, 

IDRE G-5*0, 

XR-12*.F., 

UMR«A*.F.> 

$ 

SNAM3 

UR-AA.F., 

YR-AA.F • , 

XMR-12*.F., 


I MAX- 29 2, 

IRUN-1, 

UMAG-16+0.0, 

USTR T-16*0. 0, 

USTP-16*0.0> 

$ 

$NAMA 

UMAG(1,1)— 100 

• , USTRT{ 1, 1 )*0. 

,USTP (1,1 )-30.0, 


IFREEF-O, 

IFREIG-O, 

I FREE P-2, 

DELT-0.1, 


DEBUM1-.F., 

0EBUM2- • F • , 

DEBUM3-.F., 

DEBUMA-.F., 


DEBUM6- .F. , 

DEBU1A-.F., 

OEBUMA-.F., 

DEBU22-.T., 


DE BU2 A-. F. t 

DEBU25-.T., 

DE0U2 6-.F., 

DEBU 27-.F., 


DEBU31-.F. , 

DF.BUA2- • F • , 

DEBUA3- • F • , 

METERS-. T., 


DEBUAA-.F. , 
OE8UA9-.T., 

DEBUA6-.F ., 
DEBU53-.T., 

DEBUA8-.F., 

DEBU5A-.F., 

DEBA16-.T ., 


$ 
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SNAM5 

F»81*0.0, 

FH-4*0.0, 


6*3 6*0. 0> H»48*0.0# 

GM«4*0.0, HP«8*0.0, 


$ 

SNAM6 

UBQ-O.OOE-OO, 

X I Q n 0 • 0> 
PBQ-O.OOE-OOi 
DTH«"Q • 00E-00> 
DTHD»0.0E-00, 

Z 1Q“ 0 « 00E-00 > 
UBDQ a 0.00E-00» 
XlDQ«*0.00E-00> 
PBDQ-O.OOE-OO, 


WBQ<*O.00E-00> 
ZI Q n 0 • 5 > 
PHQ«0.00E-00, 
DER B 0»00£“00> 
0ERD“7 o 00 E-OQ> 
Z2Q"0.25E-00, 
H3DQ»0.00E-00, 
Z IDQ“ 1. 00 E-00 » 
PHDQ«*0.00E-00, 


QBQ-O.OOE-OOi. 

VHQ«0.00E-00j> 

PSQ-O.OOE-OO, 

DA-O.OOE-QO* 

DARD-O.OOE-OOp 

Z3Q»0.00E-00> 

QBDQ«0.00E-00> 

VBDQ-O.OOE-OO, 

PSDQ-O.OOE-OO* 


% 

SAEROl 

IAMDA»0.0, 

$ 

*AER02 

LAMDAl-O.O, 

$ 

SNAM7 

EI-9*0.0, 

ERV"600*0.0, 

$ 


ZF.TA-0.0, 


ZETA1-0.0, 


ER«9*0.0, 

IEV"9*0, 


LAMDAGS«*3.0> 


E I «9*0. Ot 


D»16*0.0* 

DM-8*0.0> 


THQ-12.5E-00* 

RBQ-O.OOb-QQ* 

YIQ-O.OOE-OO, 

DRR-O.OOE-OO* 

DRRD -O.OOE-OO, 

Z4Q-O.OOE-OQ, 

THDQ=0.00E-00, 

RBDQ-O.OOE-OO, 

YIDQ-O.O* 


166 



APPENDIX B 


SUBMIT FILE FOR AUTOPILOT DESIGNS 


The following is a typical submit file containing the JOB CONTROL 
CARDS to execute the PIFCGT program on the NASA Langley Computer Complex 
using the NOS. 1.3 operating system (# is a blank space). 

/JOB 

PIFNAM7 , T100 , CM1 60000 . 5DT DBTAYLOR 

USER.XXXXXX. 

CHARGE , XXXXXX , LRC . 

GET,TAPE20=PIFNAM7 . 

GET,PIFLIBO/UN=1003675C. 

GET ,ORACLIB/UN=017545N. 

MAP, OFF. 

LDSET,LIB=PIFLIBO. 

LD S ET , US EP= AEROD . 

LDSET , LIB=ORACLIB . 

LDSET , PRESETA=NGINF . 

PIFCGT. 

BOMB. 

EXIT. 

ROUTE , OUTPUT , DC=PR , ID , DEF . 

SRUCOMP . 

REWIND, OUTPUT. 

COPY, OUTPUT, TAPE86 
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REWIND, TAPE8 6. 

REPLACE, TAPE86. 

BOMB. 

EXIT. 

DAYFILE , BADP . 

REPLACE , BADP . 

EXIT. 

/EOR 

$PIF#CONTROL$DE SIGNtfPROGRAM 
/EOF 

To use the subroutine FREEF, the statements 
ATTACH , FTNMLIB/UN=LIBRARY,NA. 

LDSET,LIB=FTNMLIB 

must be included. To use the subroutine DPIFSP for plotting, the state- 
ments 

GET , ICSLIB/UN=004675C . 

LDSET , LIB=ICSLIB . 

REPLACE, TAPE1=PIFPLT7 , 

must be included in appropriate locations. 
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APPENDIX C 


SEGMENTATION DIRECTIVES 


PIFCGT is a large TOP-DOWN program. Central memory would be inef- 
ficiently used if the entire program had to be loaded for the program 
to execute. With segmentation, only certain portions of the executing 
program need to be in central memory concurrently. Segmented loading 
is initiated by the execution of a SEGLOAD control statement that 
causes SEGLOAD directives to be processed as discussed in Ref. 7. The 
SEGLOAD directives for PIFCGT are (b is a blank space). 
bbINCLUDEbAEROD 

MTREE PIFCGT- (DIMSS , HDCON , CFWM, PIFMODL , PIFPLC , REMAT .DISCMOD , QRMPl , 
ORMHAT , DREG , PIFG , DPIFS , DPIFSP , FGAERO , PIFEIG , RUNINFO , INTERP , PIFFRE) 

P I FCGTtfGLOBALtfDI SCSV , W0RKS9 , WGHTS , MODF , DI SCM , PLA , DIMN 1 , DIMN2 , DIMN3 , 
DIMN4,DIMN5,SMAT,PFIG,QWHT, EIGEN, LABEL, GLAD, LINES, IDENTS, AERO, FORM 
TOL , CONV , SLVBLK , UDIR , DEBG , EIG S , HDXA , AER1 , RN INFO , RNINFO 1 , RN INF02 , 

STP . END ,FCL.C. ,Q8.IO. , FCL=ENT , FDL . COM 
t5END 

Alternate forms of memory allocation may have to be developed 
by a user depending on machine configuration. 
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